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i  The  Fast:  Adaptive  Maneuvering  Experiment  (FAME)  is  designed  to  provide  neural 
r  network  (NN)  researchers  with  a  physical,  non-linear  system  of  modest 
'  dimensionality  with  coupled  dynamics.  The  system  to  be  controlled  is  a 

eommerically  available  model  electric  helicopter  (Whisper)  which  is  secured  to  a 
comercially-available  stand  (FI itemaster ,  Jr.)  which  has  been  modified  to  limit  its 
range  of  motion  and  make  it  suitable  for  laboratory  operation.  The  stand  has  been 
instrumented  with  potentiometers  to  measure  all  6  degrees-of -freedom  (6-DOF.i.  In 
order  to  make  the  interface  to  the  system  as  simple  as  possible  a  Motorola  MC68HC11 
microcontroller  unit  (MCU)  has  been  employed  to  implement  the  RS- 232  communications 
protocol,  convert  the  voltages  on  the  potentiometers  into  angles  (8-bit 
quantization) ,  ,  erform  the  coordinate  conversions  to  a  Cartesian  space,  reply  to 
requests  from  the  KM  controller  for  helicopter  position,  and  translate  commands 
from  the  NN  controller  into  appropriate  servo  commands. 
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1.  Introduction 


The  Fast  Adaptive  Maneuvering  Experiment  (FAME)  is  designed  to  provide  neural  network  \N> 
researchers  with  a  physical,  non-linear  system  of  modest  dimensionality  with  coupled  dynamics  The 
system  to  be  controlled  is  a  commercially  available  model  electric  helicopter  (Whisper)  which  is 
secured  to  a  commercially-available  stand  (Flitemaster  Jr )  which  has  been  modified  10  limit  its  range 
of  motion  and  make  it  suitable  for  laboratory  operation.  The  stand  has  been  instrumented  with 
potentiometers  to  measure  all  6  degrees-of-freedom  (6-DOF).  In  order  to  make  the  interface  to  the 
system  as  simple  as  possible,  a  Motorola  MC68HC11  microcontroller  unit  (MCI')  has  been  employed 
to  implement  the  RS-232  communications  protocol,  convert  the  voltages  on  the  potentiometers  into 
angles  (8-bit  quantization),  perform  the  coordinate  conversions  to  a  Cartesian  space,  reply  to  requests 
from  the  NN  controller  for  helicopter  position,  and  translate  commands  from  the  NN  controller  into 
appropriate  servo  commands. 

The  source  code  for  all  of  the  software  which  has  been  developed  for  the  MCU  and  the  PC 
communications  is  provided  with  the  stand  so  that  local  modifications  can  be  made  as  needed.  It  is  in 
3  highly  modularized  form  which  allows  easy  modification  once  the  underlying  principle  of  the 
software  design  is  understood.  A  modified  commercial  MCU  board  was  used  (Motorola 
M68HCUEVB)  in  order  to  minimize  expenses  and  provide  a  limited  development/software 
modification  capability  to  individual  researchers.  The  monitor  program  on  the  board  has  been  left 
intact  and  can  be  accessed  through  the  second  serial  port  on  the  board  using  Kermit  or  other  terminal 
emulation  software.  Actual  software  development  was  done  using  a  PC-based  C  cross-compiler  and 
cross-assembler  which  supports  ANSI  C. 

The  software  on  the  MCU  is  resident  in  two  forms.  The  Motorola  Buffalo  monitor  is  in  its  original 
form  on  ROM.  The  board  has  been  modified  to  incorporate  a  32-k  byte  SRAM  with  self-contained 
battery  backup  (nominal  10  year  life).  This  memory  was  chosen  to  enable  ease  of  local  software 
modification  as  well  as  easy  incorporation  of  updated  software  in  the  field.  For  all  practical  purposes, 
the  lower  half  of  memory  is  populated  with  non-volatile  SRAM  in  which  the  program  is  stored. 
Conflicts  with  internal  RAM  and  memory  mapped  registers  are  not  a  problem  since  the  MC68HC1 1 
accesses  internal  memory  when  it  is  available.  With  this  approach,  field  changes  can  be  made  by 
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modifying  the  stored  program  directly  through  the  Buffalo  monitor  rather  than  having  u-  cr.-.ve  .-.no 
reprogram  erasable-programmable  read  only  memories  (EPROMS). 

A  calibration  program  is  included  as  part  of  the  software  so  ifw  precise  mechanical  alignment  of  the 
stand  is  not  required.  If  for  some  reason  the  stand  has  been  disassembled  and  the  potentiometers 

moved,  this  program  can  be  used  to  realign 
them  in  software.  The  user  is  prompted  to  put 
the  movable  parts  of  the  stand  in  certain 
positions.  The  MCU  then  reads  the 
potentiometers,  calculates  the  new  offsets  and 
scale  factors  and  stores  them  in  on-chip 
nonvolatile  SRAM.  There  is  no  need  to 
recalibrate  unless  the  stand  is  disassembled  or 
the  potentiometers  moved  from  their  calibrated 
positions. 


Consideration  was  given  to  a  number  of 
safeguards  which  could  be  incorporated  in  the 
MCU  software,  but  which  have  not  been 
implemented.  It  was  felt  that  any  "Deadman’s  Switch"  included  in  the  software  would  be  too  intrusive 
on  the  desires  of  NN  researchers  and  limiting  on  the  flexibility  of  their  software  design.  The  hazards 
of  operation  of  this  system  should  not  be  taken  lightly  and,  at  the  very  least,  appropriate  eyeware 
should  be  worn  when  operating  the  system. 


2.  Major  Components 

Three  major  subsystems  comprise  FAME:  the  stand,  the  helicopter,  and  the  MCU  interface  Each  of 
these  components  has  been  modified  to  integrate  them  into  a  single  system  which  can  be  controlled  via 
requests  and  commands  passed  to  it  through  an  RS-232  interface.  The  following  details  the 
modifications  which  have  been  made  to  each  as  well  as  information  which  may  be  useful  to  those  who 
are  unfamiliar  with  model  helicopter  operations. 
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2.1.  Stand 

The  stand  is  a  modified  commercially  available  Flitemaster  Junior.  This  stand  ts  usuaih  used  o>  me 
novice  helicopter  flyer  to  leam  to  hover  and  maneuver  electric  or  small  gas  helicopters  without  the 
danger  of  crashing.  Although  the  range  of  motion  is  limited,  the  stand  can  assist  m  the  development 
of  a  pilot’s  mental  framework  ana  the  eye-hand  coordination  necessary  for  control  of  this  complex, 
system. 

The  Flitemaster  was  chosen  primarily  because  it  had  6-DOF  incorporated  in  the  basic  design 
Although  there  are  other  stands  available,  this  is  the  only  one  which  has  full  6-DOF.  As  purchased, 
the  stand  needs  to  be  modified  to  make  it  suitable  for  NN  control  of  the  helicopter.  Modifications  to 
the  stand  are  as  follows: 

1.  All  axes  have  been  fitted  with  5k  Ohm  linear  potentiometers  which  are  supplied  with 
5  Volts.  The  potentiometers’  outputs  are  converted  by  the  MCU’s  A/D  conveners  for 
angular  measurements. 

2.  A  wheel  has  been  added  to  support  the  lowest  arm  to  relieve  stress  on  the  lowest  joint 
(the  center  of  the  H-frame)  and  improve  the  accuracy  of  position  measurements. 

3.  The  nylon  block  support  system  at  the  helicopter  end  of  the  stand  has  been  replaced 
with  double  roller-bearings  in  order  to  reduce  friction  and  provide  structural  support 
and  rigidity  to  the  replacement  shaft  which  supports  the  helicopter  itself. 

4.  The  final  nylon-steel  bali/socket  helicopter  support  was  replaced  with  an  inverted, 
metal  joystick.  The  potentiometers  on  this  joystick  provide  roll  and  pitch  angle 
measurements.  A  difficulty  associated  with  this  support  arrangement  which  has  not 
been  resolved  is  that  the  center  of  rotation  is  below  the  center  of  mass  of  the 
helicopter  and  therefore  during  takeoffs  u»e  helicopter  platform  must  be  supported  to 
keep  it  level  and  stop  rotation. 

5.  Brackets  were  added  to  hold  the  potentiometers  which  measure  joint  angles.  In  some 
cases,  the  brackets  are  also  used  to  limit  the  range  of  motion  of  joints  (primarily  yaw 
and  the  lowest  joint  at  the  center  of  the  H).  These  range  limiting  mechanisms  must 
not  be  tampered  with  or  the  potentiometers  (which  do  not  have  a  full  360  degrees  of 
motion)  will  be  damaged.  Shaft  encoders  could  have  been  used  to  allow  full  range  of 
motion,  but  this  would  have  been  at  a  significant  expense  which  the  budget  would  not 
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allow.  If  potentiometers  are  removed/replaced/adjusted,  care  must  be  taken  to  tn-uic 
that  they  are  secured  in  such  a  position  that  the  full  range  of  motion  of  the  joint  'Aid 
not  damage  the  potentiometer. 

6.  The  spring  support  at  the  middle  joint  has  been  modified  by  changing  spnngs  anc 
adding  tumbuckles.  Modifying  the  geometry  of  the  springing  is  ineffective  m 
compensating  for  the  additional  weight  of  the  helicopter  and  MCI’.  Some 
compensation  is  made  with  the  removal  of  the  battery  from  the  helicopter,  but  -imrcer 
springs  are  needed  to  mass  balance  the  system. 

7.  Wiring  has  been  added  to  provide  electrical  power  to  the  MCU,  power  to  the  elcctnc 
helicopter  motor,  and  carry  the  joint  potentiometer  signals  to  the  MCL  's  A/D  for 
conversion. 

The  stand  should  be  secured  to  the  fir  or  and  an  area  cleared  to  insure  unimpeded  flight  of  the 
helicopter.  If  a  permanent  mounting  cannot  be  made,  two  or  more  25  lb  bags  of  lead  shot  have  been 
used  to  keep  the  H-frame  immobile  while  the  helicopter  is  flows. 

2.2  Kalt  Whisper  Helicopter 

The  helicopter  is  manufactured  by  Kalt  and  is  commercially  available  as  the  Whisper.  The  helicopter 
and  spare  parts  are  available  at  local  hobby  shops.  Because  the  Whisper  utilizes  an  electnc  motor  us 
power  for  the  main  rotor  it  must  carry  a  nickel-cadmium  (N1CAD)  battery  on  board  for  power  In 
order  to  carry  this  load,  the  frame  is  very  light  and  therefore  not  very  strong.  It  will  not  take  much 
abuse.  In  particular,  the  ball  links  which  actuate  the  controls  are  particularly  easy  to  break  and  the  use 
of  ball-link  pliers  for  disassembly  is  strongly  encouraged. 

The  Whisper  kits  were  purchased  in  almost-ready-to-fly  (ARF)  form.  Experience  has  shown  that  the 
modest  difference  in  price  between  the  kit  and  the  ARF  kit  is  well  worth  the  savings  in  construction 
time.  The  ARF  kits  have  been  completed  and  the  helicopter  adjusted  and  aligned.  The  helicopter 
construction  msneals  are  delivered  with  FAME,  but  alignment  is  a  tedious  process  and  should  not  be 
necessary  except  in  the  event  of  mishap.  In  particular,  do  not  remove  the  tape  from  the  main  rotor 
blade(s).  This  tape  is  used  to  balance  the  rotors  as  well  as  a  sighting  device  when  the  blades  are 
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aligned  for  proper  tracking  (both  blades  following  the  same  path).  Perfect  tracking  is  jitticult  w 
obtain,  and  the  systems  are  adjusted  as  close  as  possible  when  delivered. 

There  are  two  switches  on  the  plate  which  supports  the  helicopter.  The  on/off  switch  supplies  power 
to  the  electric  speed  controller.  This  switch  is  used  in  normal  helicopter  installations  with  radios  to 
provide  a  regulated  voltage  to  the  radio  receiver.  There  is  a  second  switch,  a  push-button,  which 
enables  the  speed  controller  to  supply  electricity  to  the  motor.  There  are  two  switches  m  the  norma; 
hobby  installation  so  that  the  radio  receiver  can  be  enabled  and  a  check  made  to  insure  that  the  throttle 
is  at  such  a  setting  that  the  motor  will  not  turn  when  the  motor  is  enabled.  If  power  is  not  supplied  ;o 
the  MCU  when  the  push  button  is  enabled,  unpredictable  results  will  occur  uhe  motor  could  start 
turning  and  hit  the  person  actuating  the  button).  Insure  that  the  MCU  is  operating  and  that  the  green 
light  is  lit  on  the  motor  controller  before  pushing  the  button.  The  initial  setting  of  the  throttle  b>  the 
MCU  is  at  its  minimum  value. 

2.2.1.  Servos 

Ball  bearing  servos  are  used  throughout  to  insure  long  life  and  reliability.  The  particular  servos  used 
are  Futaba  FPS-133.  While  the  operation  of  the  servos  is  transparent  to  the  users,  a  brief  explanation 
of  the  electrical  mode  of  actuation  follows.  Each  servo  is  controlled  by  a  5  Volt  pulse  of  variable 
width.  A  pulse  width  of  1.0  ms  positions  the  servo  at  an  extreme  end  of  its  rotation.  A  pulse  width 
of  2.0  ms  positions  the  servo  at  the  other  extreme  end  of  its  rotatioa  The  nominal  zero  for  the  servo 
occurs  at  a  pulse  width  of  1.5  ms.  The  angle  between  these  two  extremes  is  proportional  to  the  pulse 
width  between  1.0  and  2.0  ms.  The  exact  values  are  not  given  here  since  there  ..re  servo-servo 
differences  and  the  linkage  is  not  necessarily  linear  between  the  servo  and  the  control  actuated  (usually 
rotary  to  linear  motion  conversion  is  involved  with  a  limited  range  of  linear  operation).  That  is,  the 
resultant  amount  of  control  action  is  not  necessarily  linearly  related  to  the  servo  command. 

The  servo  doe*  not  respond  to  a  single  pulse  width  command,  but  the  command  must  be  repeated  at 
regular  intervals  to  insure  complete  motion  to  the  commanded  angle.  In  order  to  relieve  the  NN 
controller  of  this  burden,  the  MCU  interface  continuously  sends  the  commanded  pulse  width  to  c3ch 
servo.  The  software  is  designed  such  that  a  two  bytes  control  word  covert  the  complete  range  of 
motion  of  each  servo.  That  is,  the  pulse  width  in  units  of  500  ns/unit  are  transmitted  as  unsigned 


FAME/AFOSR  Hints,  March  29,  1992 


integers  (e.g..  -000  decimal  =  !.()  ms,).  The  actual  pulse  width  is  generated  using  the  output  cump.)r. 
of  the  MC68HC1I  and  is  a  background  process  under  the  control  of  interrupts 

One  servo  is  not  mechanical  and  that  is  the  speed  controller.  The  format  of  the  control  >ign.us  lor  ,i  - 
the  same  as  the  other  servos,  but  it  is  solid-state  and  has  no  moving  parts  This  improves  re!iabiist>  .is 
well  as  accuracy  of  control  over  other  methods  which  have  a  mechanical  servo  controlling  the  position 
of  a  high  cum ; »  potentiometer.  With  this  method,  there  is  little  wasted  energy  since  the  SS  speed 
controller  is  operated  in  a  switching  mode.  Normal  model  helicopter  have  a  mixing  function 
incorporated  either  on  the  helicopter  or  in  the  transminer.  This  mixing  function  couples  the  throttle 
(SS  speed  controller)  to  the  collective  pitch.  These  are  not  coupled  in  the  MCU  implementation  and 
are  completely  separate  channels  available  for  individual  control. 

2.2.2.  Gyro 

There  is  one  single-rate  Futaba  gyro  mounted  on  the  helicopter  for  yaw  stabilization.  The  normal 
configuration  for  a  yaw  rate  gyro  is  to  have  the  tail  rotor  signal  from  the  receiver  (the  10  to  2.0  ms 
pulse)  connected  to  the  gyro.  The  gyro  then  modifies  this  pulse  width  according  to  vaw-dot  to 
generate  a  yaw  disturbance  negative  "eedback  signal.  The  Futaba  model  number  of  this  special  g>  ro 
for  electric  helicopters  is  Futaba  G-155. 

In  the  FAME  configuration,  the  yaw  rate  gyro  ip  driven  by  a  1.5  ms  pulse  from  the  MCU  in  response 
to  a  position  measurement  command  from  the  workstation.  The  pulse-width  gyro  output  is  then  read 
by  the  MCU  and  converted  to  an  eight-bit  signed  value.  This  value  can  then  be  returned  to  the 
workstation  along  with  the  6-DOF  coordinates.  Although  the  electrical  connections  are  made  on 
FAME,  the  software  does  not  yet  implement  this  function. 


2J.  M68HC11 EVB 

Motorola  sells  an  evaluation  board  based  on  its  MC68HC11  microcontroller  (MCU)  This  board  was 
selected  becaus~  of  its  low  cost  and  inclusion  of  the  port  replacement  unit  (PRU).  The  PRU  .  hows 
the  MCU  to  be  operated  in  the  expanded  mode  (one  of  its  four  modes  of  operation)  while  retaining  all 
of  the  original  ports  as  if  it  were  operating  in  the  single-chip  mode.  Operation  in  the  expanded  mode 
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allows  for  the  virtual  memory  (64  kbytes)  to  be  fully  populated  with  either  RAM  or  ROM  The 
additional  ROM  is  required  because  of  an  early  decision  to  write  as  much  code  as  possible  n  (.  .n 
order  to  make  it  easier  for  the  user  to  modify  it  to  suit  his  particular  needs.  The  print!';  s  and  Nv.jr.r- 
functions  in  particular  require  a  lot  of  space.  These  pnnting  functions  are  primarily  used  when  me 
optional  monitor  is  attached  and  operating  in  a  terminal  mode. 


An  additional  reason  for  using  the  evaluation  board  is  that  it  comes  with  complete  circuit  diagrams  a> 
well  as  a  complete  hardware  reference  manual.  Also  bundled  with  it  is  a  bare-bones  cross-assembler 
(non-macro)  which  could  be  used  in  a  pinch  to  make  necessary  modifications  to  the  MCU  code 

The  board  as  it  comes  from  the  factory  is  stuffed  with  8  kbytes  of  RAM  at  address  SCOOO  and  this  is 
retained.  A  SRAM  of  32  kbytes  is  added  to  insure  sufficient  space  for  a  high-level  language  program 
The  SRAM  chosen  has  a  built-in  battery  backup 
so  that  it  retains  its  memory  even  when  power  is 
removed.  The  SRAM  acts  as  if  it  were  an 
EEPROM  except  that  it  is  much  easier  to 
modify  in  that  it  only  needs  to  be  written  to  just 
like  any  other  RAM.  While  EEPROM  has  a 
sufficiently  short  access  time  during  operation,  it 
has  an  unacceptably  long  programming  time. 

Minor  modifications  are  made  to  the  board  and 
the  socket  for  an  optional  8  kbyte  RAM  ($6000) 
is  used  to  hold  the  32  kbyte  SRAM.  The 
following  modifications  are  required  to  utilize 
the  Dallas  DS123QY-150  32kx8  nonvolatile 
SRAM  on  the  M68HC1 1EVB: 

1.  Replace  R2  (10  kOhm)  with 

approximately  3.3k  Ohm.  Smaller  values  will  cause  the  M68HC1 1  to  sink  too  much 
current.  Larger  values  prevent  the  passive  pullup  from  charging  the  input  to  the  chip 
sufficiently  fast  Occasional  errors  occur  in  memory  if  this  is  not  done. 


Table  I  Jumper  settings  for  M68HC1 1EVB. 


Jumper  Number 

Setting 

1 

Open 

2 

2-3 

3 

Open 

4 

1-2  (Buffalo; 

2-3  (FAMEmain) 

5 

9600 

I  6 

Closed 

|  7 

Open 

!  1 
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2.  Disconnect  Jumper  J3  to  disconnect  chip  select  from  chip  select  decoder  Address  on 
15  is  used  as  CS~  to  select  the  er  half  of  memory. 

3.  Cut  the  trace  to  pin  1 1/U12E  er.  ..lively  removing  R/W*  from  pin  i  1 . 

4.  Connect  pin  11/U12E  to  pin  1/U12A  effectively  supplying  the  E-clock  to  pin  11 

5.  Connect  pin  20/U4  to  pin35  of  L'10.  This  connects  A 15  to  CS~  of  the  SRAM 

6.  Cut  the  trace  between  pin  26/U4  and  pin  28/U4. 

7.  Connect  pin  26/U4  to  pin  37/U1Q.  This  connects  A 13  to  the  SRAM. 

8.  Connect  pin  1/U4  to  pin  36/U10.  This  connects  A 14  to  the  SRAM. 

The  normal  8kx8  SRAM  at  SC000  (U5)  can  be  retained  and  is  needed  to  run  the  calibrate  program 
The  addition  of  the  32kx8  effectively  fully  populates  the  lower  half  of  M68HC1 1  memory  Those 
memory  addresses  which  are  internal  to  the  M68HC11  remain  so  and  there  is  no  conflict  between  the 
external  SRAM  a.  .ntemal  locations.  The  memory  between  $4000  and  S5FFF  may  be  unusable 
depending  on  whether  you  program  modifies  the  SCI  control  flip-flop,  U1  IB. 

As  delivered,  the  jumpers  on  the  MC68HC1 1EVB  board  should  be  as  listed  in  Table  1. 

All  signal  interconnections  are  made  to  the  board  through  the  60  pin  connector.  Power  (0  V,  +5  V)  is 
supplied  to  the  6-DOF  potentiometers  from  the  MCU  board  through  an  eight  position  Dean's 
connector  female  block.  Ground  and  signal  lines  are  supplied  to  the  helicopter  servos  through  another 
block.  Plus  5  Volts  is  not  supplied  from  the  MCU  board  since  excessive  current  drain  dunng  servo 
actuation  causes  the  board  to  malfunction.  Power  is  supplied  to  the  servos  from  the  speed  controller 
servo  (SCS)  which  has  an  internal  regulator.  The  SCS  regulates  its  +12  Volt  supply  voltage  down  to 
+5  volts  and  normally  powers  the  receiver  and  servos.  In  FAME,  this  regulated  +5  Volts  is  distributed 
to  the  servos  through  the  servo  connector  block.  A  common  ground  is  provided  between  the  MCU 
and  the  SCS. 

If  it  is  desired  to  hive  an  external  restart  button,  pin  17  of  the  60-pin  connector  can  be  extended  off 
the  stand  along  with  a  ground  wire.  Grounding  pin  17  of  the  60-pin  connector  will  restart  the  board 
as  long  as  jumper  J1  is  in  place. 
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2.3.1.  Buffalo  Monitor 

As  delivered  from  Motorola,  the  evaluation  board  has  a  resident  monitor  called  Buffalo  This  monitor 
has  a  limited  repertoire  and  is  designed  for  hands  on  experimentation  at  a  simple  level  Since  the 
monitor  does  allow  some  direct  access  to  the  MCU  as  well  as  the  ability  to  download  Motorola  S- 
record  format  files,  it  has  been  maintained.  Whether  to  restart  in  Buffalo  or  in  the  normal  FAME 
operating  program  is  determined  by  jumper  J4.  If  connected  between  pins  I  and  2  restart  causes 
Buffalo  to  come  up.  If  J4  is  connected  between  pins  2  and  3,  then  the  FAMEMAIN  program  begin.'- 
to  execute  after  pushing  the  restart  button. 

Documentation  for  Buffalo  is  found  in  the  evaluation  board  manual.  When  uploading  S-record  lormut 
files  using  Kermit,  be  sure  to  include  the  MD  on  the  transmit  command  so  handshaking  protocol  is 
eliminated,  e.g.,  "Transmit  FAMEmain.O  NO”.  This  does  not  appear  to  be  a  problem  using  PROCO.MM 
in  the  ASCII  file  upload  mode.  Note  that  one  uploads  a  file  rather  than  downloads  it  to  the  MCU 
Due  to  differences  in  the  way  operating  system  BIOSs  handle  CR/LF,  FAME  software  was  compiled 
with  only  V  rather  than  \n\r.  If  lines  overwrite  themselves,  enable  a  switch  on  your  terminal  program 
which  converts  CRs  to  CR/LF. 

2.3.2.  Power  Supply 

Two  power  supplies  are  required  for  operation  of  FAME.  One  is  supplied,  the  other  must  be  locally 
obtained.  The  one  supplied  is  a  used  IBM  PC,  63  Watt  power  supply  which  is  sufficient  to  power  the 
MCU  board  and  has  the  requisite  +12,  -12,  and  +5  Volt  taps.  The  second  power  supply  which  is 
required  is  9.6  to  12  Volts  for  powering  the  helicopter  motor.  A  circuit  diagram  of  one  used  at  Drexel 
University  is  included  in  the  appendix.  A  9.6  Volt,  1000  mAh  NICAD  battery  is  provided  to  get  you 
started,  but  will  only  supply  enough  current  for  10-15  minutes  of  operation.  These  are  the  normal 
flight  batteries.  This  battery  should  be  recharged  at  the  normal  c/10  rate  of  100  mA.  Quick  charging 
is  possible  if  care  is  taken  to  not  overcharge  the  batteries.  Constant  voltage  charge  is  NOT  an 
acceptable  method  for  recharging  NICAD  batteries.  Twelve  Volt  Gel-Cell  batteries  are 
recommended  if  a  sufficiently  robust  power  supply  cannot  be  obtained.  Conventional  wet-cell  lead 
acid  batteries  can  be  used  if  proper  ventilation  is  maintained  during  recharging  to  prevent  hydrogen 
buildup.  Normal  current  draw  for  the  motor  is  in  excess  of  10  Amperes. 
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The  power  for  the  servos  is  supplied  through  the  electronic  speed  controller,  so.  in  order  tor  tno 
to  function  under  68HC11  control,  power  must  be  supplied  to  the  speed  controller  and  it  must  be 
switched  on.  As  long  as  the  push-button  is  not  pushed,  power  will  not  be  supplied  to  the  motor, 
although  the  green  and  red  lights  on  the  speed  controller  will  change  as  it  is  still  receiving  commands 
The  +5  from  the  speed  controller  and  the  68HC1 1EVB  are  not  tied  together  There  is  a  common 
ground  reference  between  the  two  so  that  the  signals  from  the  EVB  can  control  the  servos. 


3.  Operational  Interface 

The  basic  communication  principle  employed  between  the  users  workstation  and  the  MCU  is  that  the 
MCU  responds  to  commands  passed  to  it  from  the  workstation  over  an  RS-232  bidirectional 
connection  operating  at  9600  baud.  Commands  include  servo  control  data  and  position  requests 
among  others.  These  commands/requests  are  in  the  form  of  a  serial  byte  string  composing  a  start 
character,  a  control  character,  one  or  more  data  bytes,  a  checksum,  and  a  stop  character.  The  message 
format  must  be  exact  or  it  is  rejected.  The  user’s  workstation  software  should  check  for  a  response 
from  the  MCU  within  a  short  time  to  insure  that  has  received  the  message  and  is  working  properly 
The  accompanying  PC  based  software  incorporates  such  checking. 

3.1.  MC68HC11  Communications 

There  are  two  serial  communication  ports  on  the  M68HC11EVB.  The  one  which  is  internal  to  the 
MCU  is  used  for  communications  with  the  workstation  and  is  under  the  direct  control  of  the 
FAMEMAIN.C  program.  The  other  serial  port  is  handled  by  an  off-chip  8250  UART  and  is  used  to 
communicate  to  a  terminal  (usually  a  PC  running  a  terminal  emulation  program  such  as  Kermit  or 
Procomm).  In  normal  operation,  the  terminal  does  not  need  to  be  connected  and  is  only  necessary  for 
using  the  BUFFALO  monitor,  downloading  modified  programs,  or  using  special  testing  software 

Serial  communkadons  to/from  the  workstation  are  handled  in  the  MCU  through  an  interrupt  driven 
Serial  CommuniaBions  Interface  (SCI)  routine.  The  complete  message  is  stored  character  by  character 
as  it  is  received  and  the  checksum  and  format  verified  before  a  semaphore  is  set  indicating  the 
reception  of  a  complete  message.  When  the  foreground  detects  this  message  received  semaphore,  it 
enables  other  foreground  and  background  functions  to  take  place  by  setting  or  clearing  other 
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semaphores.  The  dichotomy  between 
foreground/background  emphasizes  the 
architectural  uniqueness  of  the  MCU  in  that 
many  functions  can  be  performed  in  hardware 
with  interrupts  indicating  their  completion. 
Extensive  use  is  made  of  this  feature  so  that 
TX/RX  communications  can  be  maintained  in 
the  background  while  interruptable  foreground 
processes  continue. 


3.2.  Workstation/MC68HCll  Message 
Formats 

There  are  several  messages  which  can  be  sent 
between  the  workstation  and  the  MCU.  The 
start  character  is  ASCII  "S"  and  the  stop 
character  is  ASCII  ”s".  The  checksum  is  the  modulo  256  sum  of  all  data  except  the  start  character, 
the  checksum  byte  and  the  stop  character.  The  position  variables  are  all  16-bit  integers  and  the  most 
significant  byte  (MSB)  must  be  put  in  PostTXbuffli]  and  the  least  significant  byte  in  PosTXbuffli-! ; 
Data  are  not  encoded  as  characters,  but  are  the  actual  binary  values  which  must  be  concatenated  The 
number  in  parenthesis  is  the  position  of  the  character  or  byte  in  the  message  string.  The  available 
messages  are  listed  in  Table  III. 

3.3.  Workstation  (PC)  Communications 

In  order  to  verify  proper  software  operation,  a  communications  protocol  interface  is  supplied  which  is 
PC  based  If  a  PC  is  not  available,  then  the  C  source  can  be  recompiled  for  alternative  machines.  The 
program  is  not  a  control  program,  but  rather  the  skeleton  of  a  communications  routine  which  would  be 
included  as  pvt*  a  neural  network  control  implementation.  Of  particular  interest  to  PC  users  is  the 
interrupt  service  routine  for  serial  communications.  MS-DOS  does  not  use  an  ISR  for  serial 
communications  and  is  therefore  not  suitable  for  MCU  communications.  This  difficulty  is 
circumvented  by  installing  an  ISR  to  handle  serial  communications.  There  appears  to  be 
incompatibilities  among  PC  hardware  and  the  software  is  not  guaranteed  to  work  on  all  PCs.  It  was 


Table  D  Signal  description  for  6-pm  Molex 
connector  supplying  power  to  stand. 


Pin  Number 

Description 

Color  Code 

1 

Motor  Gnd 

Thick 

Black  (#12) 

2 

Motor  +12  V 

Thick  Red 

(#12) 

3 

6811  Gnd 

Black 

4 

6811  +5V 

Brov.n 

5 

6811  -12V 

Red 

6 

6811  +12V 

Orange 
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Table  HI  Workstation/MCU  Message  formats. 


Originator 

Message 

Message  String 

Workstation 

Request  Position  Values 

Start  Char(O),  R(l),  Stop  Chart 2) 

Workstation 

Command  Servo  Control 

Start  Char(O),  C(  1).  Servo  Control  Values! 2-1 1  ■. 
Checksum(12),  Stop  Chart  13) 

Workstation 

Request  Potentiometer 

Values  (not  yet 
implemented) 

Start  ChaitO), _ (1),  Stop  Char(2) 

MCU 

Send  Position  Values 

Start  Char(0).  P(l).  XC2-3).  Y(4-5»,  Zi6-7j. 

RoU(8-9),  Pitch(lO-n').  Yaw(12-13>. 

Checksum!  14).  Stop  Chard 5) 

MCU 

Send  Acknowledgement  of 
receipt  of  control  values 

Start  Ch.  i,  A(l),  Stop  Char(2) 

MCU 

Send  Potentiometer  Values 
(not  yet  implemented) 

Start  Char(0).  (1).  H-Pot(2-3).  Az-Pot(4-5j. 

El-Pot(6-7),  Roll  Pot(8-9),  Pitch  Pot(lO-ll). 

Yaw  Pot(12- 13),  Checksum(14),  Stop  Char(15) 

developed  using  Borland  C++  and  ran  successfully  on  an  ATT-6300  (286)  and  an  INTRA  LT-386sx 
laptop  (it  did  not  run  on  a  Zenith  386/16). 

3.4.  Coordinate  Conversion 

The  measurer  ts  of  the  6-DOF  are  not  made  in  Cartesian  space  but  rather  in  joint  space.  These 
angular  measu  rents  are  converted  by  the  MCU  into  an  X,  Y.  Z.  roll,  pitch,  and  yaw  format.  This  is 
done  by  applying  the  calibration  values  which  are  stored  in  nonvolatile  RAM  to  the  measurements  and 
then  computing  the  Cartesian  coordinates  through  trigonometric  conversions.  The  roll,  pitch,  and  yaw 
do  not  require  coordinate  conversions  since  they  are  measured  directly.  A  scale  factor  stored  in 
nonvolatile  RAM  is  still  applied  to  convert  the  measured  voltages  into  angles.  Units  for  these 
measurements  ut  centimeters  for  X,  Y,  and  Z  and  degrees  for  Roll,  Pitch,  and  Yaw.  Scaled  values 
are  transmitted  to  maintain  resolution.  The  current  version  of  the  software  (1.0)  scales  all  values  by  a 
factor  of  100  before  transmitting  them  back  to  the  PC. 
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3.5.  Servo  Outputs 

In  normal  radio  controlled  operation,  servos  expect  to  receive  their  1.0  to  2.0  ms  signal  pulse  once  per 
1600  sec.  Although  the  interval  does  not  have  to  be  this  long,  they  will  malfunction  with  too  short 
an  interval.  As  there  was  not  enough  output  compare  to  control  all  the  servos,  each  output  compare 
controls  1  pin  PA  and  1  pin  PB. 

Table  IV  Servo  block  connections. 


Output  Compare 
Number 

Servo  Block 

CONNECTOR 

Number 

Port  Number 

MCU  Pin 
Number 

Servos 

Controlled 

OC3 

6 

PAS 

29 

Collective 

OC3 

5 

PB2 

40 

To  Gyro 

OC4 

4 

PA4 

30 

Rudder 

OC4 

3 

PB1 

41 

Elevator 

OC5 

2 

PA3 

31 

Aileron 

OC5 

1 

PBO 

42 

Throttle 

IC1 

0 

PA2 

32 

From  Gyro 

The  servo  connections  are  organized  as  shown  in  Table  IV: 

3.6  A/D  Input  Block 

The  six  potentiometers  which  measure  the  angles  of  the  six  joints  are  connected  to  the  MCU  through  a 
multi-connector  block  immediately  behind  the  M68HC1 1EVB.  As  with  the  servo  connections,  the 
wires  are  numbued  with  the  corresponding  number  on  the  block.  Power  is  supplied  to  the  A/D  block 
from  the  of  the  M68HC1 1EVB.  The  A/D  channels  and  connector  biock  pin 

assignments  are  as  in  the  following  table. 

3.7.  System  Verification  Software 

A  PC  based  program,  FAMEPC.C,  is  provided  which  demonstrates  the  control  capability  available 
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Table  V  A/D  converter  signal/pin  assignments. 


A/D 

Channel 

A/D  Register 

Port 

Number 

M68HC1 1EVB 
pin  Number 

A/D 

BLOCK 

PIN 

Number 

Signal 

1 

ADRl 

PEO 

43 

- 

Buffalo 

2 

ADR2 

PEI 

45 

1 

RoLi  ( 3 Y j 

3 

ADR3 

PE2 

47 

3 

Yaw  1 3Zi 

4 

ADR4 

PE3 

49 

5 

Pitch  <3X1 

5 

ADRl 

PE4 

44 

0 

A/<  2Z  i 

6 

ADR2 

PE5 

46 

2 

E I  ( 2  X ! 

7 

ADR3 

PE6 

48 

4 

H  (1Z) 

8 

ADR4 

PE7 

50 

6 

- 

through  the  RS-232  interface  to  the  MCU. 

Servo  position  values  can  be  typed  in  directly  in 
milliseconds  of  control  value  (from  1.0  to  2.0 
ms)  or  the  individual  servos  increased  or 
decreased  by  their  smallest  value  through 
pushing  the  upper  case  value  of  the  controlling 
letter  or  the  lower  case  letter  respectively.  The 
controlling  letters  are  shown  in  Table  VI. 

3.8.  Calibration 

In  order  to  eliminate  tedious  alignment  of 
potentiometers  at  each  joint,  it  was  decided  to 


Table  VI  PC  keyboard  controls. 


SERVO 

CONTROLUNC 

(UC  Increases.  LC  c 

Throttle 

T  c 

Tail  Rotor 

R  o 

Collective 

C  o 

Elevator 

E  o 

Aileron 

A  c 

align  the  joints  electrically  rather  than  mechanically.  That  is,  the  exact  position  of  the  potentiometer  is 
not  important  as  long  as  it  can  be  corrected  prior  to  its  use  in  the  conversion  Cartesian  coordinate 
conversion.  This  is  done  by  measuring  die  voltages  produced  at  specified  angles  during  a  calibration 
program  and  computing  a  zero  and  scale  factor.  These  factors  are  stored  in  nonvolatile  RAM.  As 
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long  as  the  stand  is  not  disassembled,  there  is  no  need  to  recalibrate  since  the  correction  values  arc 
stored  in  nonvolatile  storage  which  is  retained  even  if  power  is  removed. 

The  calibration  program,  FAMECAL.C,  must  be  downloaded  into  the  M68HC1 1EVB  and  started  usire 
the  Buffalo  monitor.  A  terminal  emulator  must  be  connected  through  the  port  other  than  the  one 
which  is  connected  to  the  workstation.  Communications  are  at  9600  baud,  no  parity,  one  stop  bit.  If 
power  is  removed  from  the  evaluation  board,  the  program  will  be  lost  since  pan  of  it  is  loaded  into 
volatile  RAM.  This  is  not  the  case  for  FAMEMAIN  since  it  all  resides  in  non-volatile  RAM. 

3.9  DOF  Range  Limitation 

There  is  a  red  colored  round  collar  immediately  below  the  platform  which  holds  the  helicopter  That 
ring  is  fixed  in  position  with  screws.  The  collar  is  there  to  limit  the  range  of  motion  in  the  roll,  pitch, 
and  yaw  axes  during  initial  NN  control  program  development.  The  total  range  of  motion  about  these 
axes  is  great  enough  with  the  red  collar  removed  that  the  tail  rotor  and  boom  can  strike  the  stand  and 
cause  extensive  damage  to  the  helicopter.  After  some  confidence  is  gained  in  the  control  algorithms 
and  its  implementation,  the  red  collar  can  be  lowered  by  removing  the  two  screws  and  drilling  and 
tapping  new  holes  at  a  lower  position.  The  tap  size  is  6-32. 

An  easier  way  to  lower  the  collar  is  to  compress  the  springs  by  tightening  the  bolts  which  hold  the 
two  red  rings  together.  The  best  alternative  which  will  allow  complete  range  of  motion  and  yet  not 
require  the  removal  of  the  platform /helicopter  as  detailed  below  is  to  remove  the  four  bolts/springs 
which  couple  the  two  and  then  use  shorter  bolts/nuts  to  hold  the  two  red  rings  together  with  no 
distance  between  them. 

Complete  removal  of  the  collar  requires  that  the  helicopter  and  platform  be  removed  from  the 
supporting  shaft.  This  could  be  done  either  of  two  ways.  The  recommended  removal  technique  is  to 
disconnect  all  of  die  wires  from  the  helicopter/platform  to  the  servo  and  A/D  blocks  as  well  as  the 
motor  power  supply.  Slowly  rotate  the  helicopter/platform  counter  clockwise  (CCW)  when  viewed 
from  above  until  the  alien  head  bolt  which  limits  the  range  of  motion  of  the  yaw  axis  makes  contact 
with  the  bracket  at  the  bottom  of  the  platform  supporting  shaft.  Continue  turning  the  platform  with 
steady  CCW  pressure  until  the  threaded  portion  of  the  shaft  disengages  from  the  inverted  joystick  on 
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che  platform  (the  joystick  measures  roll  and  pitch  angles).  It  will  take  several  turns  to  remove  the 
platform  from  the  supporting  shaft.  The  washers  are  required  between  the  shaft  and  the  joystick  to 
compensate  for  the  fact  that  the  threads  could  not  be  machined  completely  to  the  flat  face  of  the  shaft 
and  it  is  the  flat  face  of  the  shaft  which  must  mate  with  the  flat  surface  of  the  joystick  to  produce  true 
rotational  motion.  The  number  of  washers  determines  the  zero  yaw  position  of  the  helicopter  Some 
washers  must  be  present  when  reassembling  the  platform/shaft.  Be  sure  to  use  Locktite  on  the  threads 
when  reassembling  and  do  not  overtighten  as  there  is  a  chance  of  stripping  the  threads  in  the 
aluminum  joystick  (they  are  quite  expensive)  or  shearing  the  threaded  portion  of  the  supporting  shaft 
(which  is  custom  made). 

A  less  desirable  alternative  is  to  disconnect  all  wires  as  above  and  then  unscrew  the  alien  head  cap 
screw  which  connects  the  supporting  shaft  to  the  yaw  axis  potentiometer  at  the  bottom  of  the  shaft.  If 
the  spring  clip  immediately  above  the  alien  head  capscrew  is  then  removed,  the  shaft  should  be  able  to 
be  pulled  upwards  through  the  two  roller  bearings,  effectively  removing  the  shaft,  platform,  and  the 
helicopter  simultaneously.  This  method  is  not  recommended  as  the  alignment  of  the  bearings  is 
critical  for  smooth  operation  about  the  yaw  axis  and,  more  importantly,  the  yaw  axis  potentiometer 
must  the  be  recalibrated  both  electrically  and  mechanically.  Electrical  alignment  is  required  so  that  the 
proper  angle  is  measured  by  the  A/D  converter.  Mechanical  alignment  is  required  to  insure  that  the 
alien  head  capscrew  limits  the  range  of  motion  about  the  yaw  axis  so  that  the  potentiometer  is  not 
destroyed.  The  potentiometer  is  not  strong  enough  in  rotation  to  stop  the  helicopter  and  a  mechanical 
stop  must  be  used. 

There  is  a  second  purpose  for  the  red  collar.  A  close  inspection  will  reveal  that  one  of  the  screw/nut 
pairs  through  the  springs  is  reversed  which  causes  the  nut  to  protrude  slightly  above  the  red  ring.  This 
is  done  so  that  the  helicopter  platform  has  something  to  push  against  while  the  rotor  speeds  up  and 
before  the  tail  rotor  has  reached  an  effective  speed  for  controlling  yaw.  Once  the  helicopter  is 
hovering,  the  plMfbim  does  not  make  contact  with  the  nut.  The  commercial  speed  controller  which  is 
supplied  does  oot  have  a  slow  ramp  up  and  tends  to  jerk  the  main  rotor  even  with  minimal  control 
action.  This  too  can  cause  the  helicopter  to  yaw  violently  leading  to  the  possibility  of  damage. 
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3.10  Connector  Wiring 

The  standard  connector  for  wir.ng  signals  is  the  “Dean's"  connector.  This  is  a  three  pm  connector 
which  we  have  used  in  the  following  standard. 


One  end  of  the  connector  is  distinguished  by  a 
groove  between  two  pints.  Starting  at  this  end, 
the  signals  on  the  connector  are:  Signal,  +5 
Volts,  ground.  This  is  true  for  the 
potentiometers  used  to  measure  the  angles  as 
well  as  the  servos.  It  is  possible  to  connect 
these  connectors  backwards  in  spite  of  the  fact 
that  there  is  a  different  spacing  between  the 
signal  and  +5V  pin.  The  notches  must  line  up. 
On  connecting  the  Dean’s  connectors  to  the 
servo  and  A/D  block,  note  that  the  block  has  a 
the  connector. 


Table  VU  Signal  description  for  4-pm  Molex 
connector  supplying  power  to  MC63HC1 1EVB 


Pin 

Signal 

Color 

1 

Ground 

Black 

2 

+5  Volts 

Brown 

3 

-12  Volts 

Red 

4 

+  12  Volts 

Orange 

line  which  indicates  the  position  of  the  groove  in 


Exercise  caution  when  wiring  around  the  servo  and  A/D  blocks  which  are  epoxied  to  the  stand  behind 
the  MC68HCI1EVB  as  the  pins  which  protrude  from  the  blocks  (next  to  the  connectors  which  are 
plugged  in)  have  +5  Volts  and  Ground  on  the  lower  two  pins  . 

The  system  has  been  supplied  with  an  6-pin  Molex  connector  through  which  power  connections  are 
made  to  the  system  from  the  external  motor  power  supply  and  the  PC  power  supply.  The  voltages  on 
these  pins  are  as  listed  in  Table  VII.  Female  pins  are  used  on  the  power  supply  side  and  male  pins 
used  on  the  stand  side. 

A  four  pin  Molex  connector  is  used  to  connect  power  to  the  MC68HC1 IEVB.  The  voltages  on  these 
pins  are  as  listed  m  Table  VII. 


4.  Software  Development 

All  of  the  MCU  software  was  developed  using  a  C  cross-compiler/cross-assembler  from  INTROL 
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corporation.  If  further  development  by  the  user  is  desired  this,  or  a  similar  cross-compiler  cross- 
assembler,  needs  to  be  purchased.  All  of  the  source  code  tor  both  the  PC  a-\i  the  MCU  is  avariabic 
on  disk  as  well  as  listed  in  the  appendices  The  emphasis  was  ot.  C  with  only  those  portions  ot  axJo 
requiring  the  fastest  processing  cr  unusual  hardware  control  wntten  in  assembly  language 

PC  based  software  for  the  calibration  program  and  sending/receiving  of  commands,  requests,  and 
messages  was  developed  using  Borland  Turbo  C++,  although  no  ++  enhancements  were  used  anu  the 
program  was  compiled  with  Turbo  keyword:  on  so  that  PC  specific  I/O  routines  could  be  used. 

4.1.  Foreground/Background  Software  Design 

The  im  >lementation  of  the  code  is  best  understood  with  reference  to  a  foreground/background 
approach.  Interruptable  processes  are  run  in  the  foreground  with  their  execution  and  behavior 
controlled  by  tokens  which  are  either  set  in  other  processes  or  in  the  interrupt  service  routines.  Some 
tokens  are  hardware  flags  which  are  read  to  determine  their  TRUE/FALSE  value.  For  example,  the 
serial  communications  interface  (SCI)  in  the  MCU  is  interrupt  driven.  Upon  receipt  of  a  character,  the 
interrupt  service  routine  (iSR)  first  checks  to  see  if  there  are  any  errors  (overrun  or  framing),  then 
checks  for  start  character  and/or  command  character,  stores  data  characters  and  then  compares  the 
locally  generated  checksum  with  the  one  transmitted.  Only  when  all  of  these  checks  are  complete  in 
the  background  ISR  is  a  semaphore  set  which  tells  the  foreground  process  that  a  complete  message  has 
been  received. 

Hardware  background  processes  are  used  extensively  because  they  are  readily  available  on  the  68 1 1 
MCU.  For  example,  the  pulses  sent  to  the  servos  are  controlled  through  the  use  of  the  output  compare 
(OC)  registers  in  the  MCU.  These  registers  are  loaded  with  a  value.  Wnen  the  value  in  the  OC 
register  matches  that  of  the  internal  free-running  counter  (TCNT),  an  interrupt  is  generated.  Since 
there  are  only  5  OCs,  three  of  them  are  used  to  drive  two  servos.  The  ISR  for  an  OC  determines 
which  servos  polae  width  has  passed  and  clears  it  to  zero  before  reloading  the  OC  register  with  a  value 
that  will  tell  it  when  to  turn  off  the  other  servo  which  it  controls.  It  must  be  emphasized  that  these 
OCs  are  hardware  compares  which  operate  in  the  background  and  generate  an  interrupt  when  their 
value  matches  that  of  the  free-running  counter.  After  both  pulses  are  cleared  to  a  low  value,  the  array 
of  pulse  widths  is  read  to  determine  the  duration  of  the  low  value  and  this  is  umed.  After  the  low 
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value  interrupt  occurs,  a  new  round  of  high  pulses  is  programmed.  The  OCs  are  loaded  from  :ne 
arrays  which  store  the  values.  It  is  the  foreground  process  which,  alter  detecting  a  message  received 
semaphore,  reads  the  command  message  and  stores  the  data  in  the  arra-  of  pulse  width  duration 
values.  Since  the  actual  PWs  are  generated  in  the  background  continually,  the  new  pulse  widths  are 
output  as  soon  as  they  arrive.  Output  pulses  are  generated  sequentially,  the  automatic  bit  set  feature 
the  OC  was  not  used. 

4.2.  M68HC11EVB  Buffalo  Monitor 

The  Motorola  supplied  Buffalo  is  maintained  intact  in  the  evaluation  board.  Its  limited  repertoire  is 
still  usable  for  unassembling  or  modifying  the  executable  code.  On  restart,  the  MCU  fetches  the 
address  of  the  startup  routine  from  locations  SFFFE/FFFF.  As  delivered  in  the  68HC11EVBU,  this 
points  to  the  Buffalo  monitor.  In  order  to  start  in  either  Buffalo  or  FAME,  the  user  must  set  jumper 
4  to  connect  pins  2-3  rather  than  pins  1-2  for  Buffalo.  The  Buffalo  monitor  reads  this  jumper  to 
determine  which  mode  of  operation  is  desired.  For  users  without  a  PC.  this  allows  using  FAME 
without  always  having  to  start  up  in  the  Buffalo  monitor  and  then  switch  to  FAME  through  the  GO 
command. 

4.3.  INTROL  C  Cross-Compiler/Cross-Assembler 

To  one  familiar  with  Borland  C++,  the  INTROL  cross-compiler  is  a  bit  difficult  to  use.  The  error 
messages  are  sometimes  cryptic,  and  the  linker  command  file  (which  controls  the  object  module 
linking  process)  is  difficult  to  set  up.  To  minimize  confusion  about  the  method  of  locating  the  ISRs 
and  their  pointers  during  the  linking  process,  the  linker  command  file  is  listed  in  section  6.3. 
Appendix  III. 


5.  System  Support 

Questions  concerning  FAME  can  be  directed  by  email  to  khintz@fame  gmu.edu.  Very  limited  repni 
parts  are  available  from  GMU  and  the  user  is  expected  to  become  self-sufficient  once  delivery  of 
FAME  is  made.  To  assist  in  that  end,  the  next  section  lists  suppliers  of  the  various  components. 
Dimensioned  drawings  of  custom  mechanical  parts  are  available  and  included  in  the  appendix. 
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Also  available  for  1  week  loan  are  two  VHS  video  tapes  which  are  a  basic  introduction  to  model 
helicopter  construction  and  flying.  The  two  titles  which  we  have  from  the  Milt  Video  Library 
"Model  Helicopter  Building  and  Flying  Techniques",  and  "Advanced  Helo  Flight  Course,  Intermediate 
and  Advanced  Techniques.”  Don’t  rush  out  and  buy  them,  but  they  are  worth  borrowing  from  us 

5.1.  Spare  Parts  (suppliers) 

Ace  R/C  Inc. 

1 16  W.  19th  Street 
P.  O.  Box  511 
Higgirtsville,  MO  64037 
(816)584-7121 
FAX  (816)584-7766 

Radio  control  electronic  parts.  Deans  Connectors 

Helicopter  World,  Inc. 

521  Sinclair  Frontage  Road 
Milpitas.  CA  92035 
(408)942-9521 
FAX  (408)942-9524 

Kalt  Whisper  Helicopter 
Flitemaster  Junior  Stand 
Futaba  G155  Gyros 
Futaba  SI 33  Servos 

Miniature  Aircraft  USA 
2324  N.  Orange  Blossom  Trail 
Orlando,  FL  328D4-4896 
(407)422-1531 

X-Cell  Gas  Helicopters  (not  used  in  electric  FAME) 


« 


1 


« 


4 


1 


i 
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Motorola 

Microprocessor  Products  Group 
6501  William  Cannon  Drive  West 
Austin,  Texas  78710 

Design  Kit,  68HC11EVB 

Sterling  Electronics 
6304  Woodside  Ct. 

Columbia,  MD 
1-800-767-7176 

Dallas  Semiconductor  256  kbyte  nonvolatile  SRAM  #DS1230Y-I50ns 

Digikey  Corp 

701  Brooks  Avenue  South 

P.  O.  Box  677 

Thief  River  Falls,  MN  56701-0677 
1-800-344-4539 

Molex  Connectors  #03-09-204  (4  pin  plug),  #03-09-1041  (4  pin  receptacle) 
ASC  60G-ND  Socket  Connector,  60  pin,  gold 
ASSR60-ND  60  pin  strain  reliefs 

Introl  Corporation 
647  W.  Virginia  Street 
Milwaukee,  WI53204 
(414)276-2937 
fax  (414)276-7026 

M68HC1 1  C  cross-compiler  and  cross  assembler 

TO  Inc. 

6420-B  Dobbin  Dr. 

Columbia,  MD  21045 
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(301)995-1331 


Potentiometers,  RV6NAYSD502A,  Type  W,  5k.Ohms,  Linear  Taper,  single  turn 
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6.  Appendices 


6.1.  Appendix  I:  MC68HC11  C  Source  Code 


This  code  is  included  for  reference  only.  It  is  a  fully  functional,  correctly  operating  program  but  docs 
not  contain  the  latest  updates.  Please  contact  khintz@fame.gmu.edu  for  the  most  recent  version  of  the 
code. 

/*  George  Mason  University 

/*  Department  of  Electrical  and  Computer  Engineering 

/* 

/*  File  name:  FAMEDEF . h 
/* 

/*  Authors:  Bertina  Ho-Mock-Qai,  Darrell  Duane,  Ken  Hinrj 
/*  Update  History:  Version  1.0,  February  23,  1992 


/* 

/*  Header  file  for  FAME  operating  program  in  M68HC11 
/*  *  / 

/* - - „/ 


♦ifndef  FALSE 
♦define  FALSE  0 
♦define  TRUE  ! FALSE 
♦endif 


/*-- - - ------- - — - * - -■ - - - ----- - -~*  / 

/*  masks  used  for  bitwise  operations  on  registers  or  variables  */ 


/* 


♦define 

MASKO  OxFE 

/* 

1111 

1110 

*/ 

♦define 

MASK1  OxFD 

/* 

1111 

1101 

*/ 

♦define 

MASK2  OxFB 

/* 

1111 

1011 

*/ 

♦define 

MASK3  0xF7 

/* 

1111 

0111 

*/ 

♦define 

MASK4  OxEF 

/* 

1110 

1111 

*/ 

♦define 

MASK5  OxDF 

/* 

1101 

1111 

*/ 

♦define 

MASK6  OxBF 

/* 

1011 

1111 

*/ 

♦define 

MASK7  0x7F 

/* 

0111 

1111 

*/ 

♦define 

CMASKO  'MASKO 

/* 

0000 

0001 

*/ 

♦define 

CMASK1  -MASK1 

/* 

0000 

0010 

*/ 

♦define 

CMASK2  -MASK2 

l* 

0000 

0100 

*/ 

♦define 

CMASK3  -MASK3 

/* 

0000 

1000 

*/ 

♦define 

CMASK4  -MASK4 

/* 

0001 

0000 

*/ 

♦define 

CMASK5  -MASKS 

/* 

0010 

0000 

*/ 

♦define 

CMASK6  -MASKS 

/* 

0100 

0000 

*/ 

♦define 

CMASK7  -MASK7 

/* 

1000 

0000 

*/ 

♦define 

IC1  NUM  0 

/* 

number  of 

input 

capture 

1 

*/ 

♦define 

IC2~ HUM  1 

/* 

number  of 

input 

capture 

2 

*/ 

♦define 

IC3~NUM  2 

/* 

number  of 

input 

capture 

3 

*/ 

♦define 

OC1  NUM  0 

/* 

number  of 

OC 

capture 

1 

*/ 

♦define 

OC2  NUM  1 

/* 

number  of 

oc 

capture 

1 

*/ 

♦define 

OC3  NUM  2 

/* 

number  of 

OC 

capture 

1 

*/ 

♦define 

OC4  NUM  3 

/* 

number  of 

oc 

capture 

1 

*/ 

♦define 

OC5  NUM  4 

/* 

number  of 

oc 

capture 

1 

*7 

♦define 

PA3  3 

/* 

pin 

number  on  port  A 

*/ 
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♦define  PA4  4 
'define  PAS  5 
♦define  PA6  6 
♦define  PBO  0 
♦define  PB1  1 
♦define  PB2  2 


/*  pin  number  on  port  A 
/*  oin  number  on  port  A 
/*  pin  number  on  port  A 
/*  pin  number  on  port  A 
/*  pin  number  or.  port  A 
/*  pin  number  on  port  A 


♦define  A_LOW  0 
♦define  A_HIGH  1 
♦define  B_LCW  2 
♦define  B  HIGH  3 


/*  indicates  status  of  servo  outputs  • 


♦derine  PI  3.14159265359  /*  value  for  pi  */ 

♦define  RADIANS_TO_DEGREES  < (double ) 1 30 / (double) PI )  /'conversion  * 
♦define  ANGLE_TX_SCALE_FACTOR  100  /*  scale  for  tx  angle  integers  • 
♦define  POSITION_TX_SCALE_FACTOR  100  /*  scale  for  tx  pcs  integers  * 


♦define  ANGLE_lz0  0  /*  calibration  location  0  for  pet  Iz  * 

♦define  ANGLE_lzl  (PI) 

♦define  ANGLE_2xO  0 

♦define  ANGLE_2xl  ( -PiOverFour) 

♦define  ANGLE_2zO  0 
♦define  ANGLE_2zl  (PiOverTwo) 

♦define  ANGLE_3pitchO  0 

♦define  ANGLE_3pitchl  N/A  /*  this  value  prompted  for  from  user  */ 

♦define  ANGLE_3rollO  0 

♦define  ANGLE_3rolll  N/A  /*  this  value  prompted  for  from  user  ’/ 

♦define  ANGLE_3yawO  0 
♦define  ANGLE_3yawl  (PiOverTwo) 

♦define  ATOD_ERROR_LIMIT  10  /*  sum  of  max  differences  in  four  A/D  samples  *' 


/* . 


/*  defines  for  initializing  RAM  ISR  jump  table 


/* - - - - 


♦define  JUMPEXTENDED  0x7E  /'Assembly  language  inst.  for  ISR  jump  table 


♦define 

VSCI 

OxOOC4 

/* 

Serial  Communications  Interface 

*  .■ 

♦define 

VSPI 

0X00C7 

/* 

Serial  Peripheral  Interface 

* 

♦define 

VPAIE 

QX00CA 

/* 

Pulse  Accumulator 

* 

♦define 

VPAO 

0X00CD 

/* 

*  • 

♦define 

VT“F 

OXOODO 

/* 

Timer  Overflow 

* 

♦c  -  tine 

V-  5 

0X00D3 

/* 

Output  Compare  5 

*  f 

♦cef ine 

v  :4 

0X00D6 

/* 

Output  Compare  4 

' 

♦define 

VII  S3 

0X00D9 

/* 

Output  Compare  3 

#  / 

♦define 

VTOC2 

OXOODC 

/* 

Output  Compare  2 

*  ; 

♦define 

VTOC1 

0X00DF 

/* 

Output  Compare  1 

-  , 

♦define 

VTIC3 

OXOOE2 

/* 

Input  Capture  3 

* 

♦define 

VTIC2 

0X0OE5 

/* 

Input  Capture  2 

♦define 

VTIC1 

0X00E8 

/* 

Input  Capture  1 

*  / 

♦define 

VRTI 

OXOOEB 

/* 

Real  Time  Interrupt 

*  / 

♦define 

VIRQ 

0X00EE 

/* 

Maskable  Interrupt  Request 

*  / 

♦define 

VXIRQ 

0X00F1 

/* 

Non-Maskable  Interrupt  Request 

r  / 

♦define 

VSHI 

OX00F4 

1* 

Software  Interrupt 

*  / 

♦define 

VILLOP 

0X00F7 

/* 

Illegal  Operation 

*  f 

♦define 

VCOP 

0X00FA 

/* 

Computer  Operating  Properly 

*  ' 

♦define 

VCLM 

0X00FD 

/* 

*  / 

♦define 

VRST 

$E000 

/* 

Restart  Buffalo  Monitor  using  assembly 

*  / 
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/* — - - 

/* 

/* - — 

/*  Disable  TX  data  buffer  empty  interrupt 
#define  DisableTXbuf fEmptylnt ( )  ClearBit (SCCR2_Add, 7) 

/*  Enable  TX  data  buffer  empty  interrupt 
♦define  EnableTXbuf fEmptylnt ( )  SetBit (SCCR2_Add, 7) 

/*  Disable  TX  complete  interrupt 

♦define  DisableTXcorapletelnt ( )  ClearBit (SCCR2_Add, 6) 

/*  Enable  TX  complete  interrupt 

♦define  EnableTXcompleceI.it { )  Setoit iSCCR2_Ada, 6) 

/*  Disable  RX  start  interrupt 

♦define  DisableRXint 0  *  ClearBit (SCCR2_Add, 5) 

/*  Enable  RX  start  interrupt 

♦define  EnableRXint ( )  SetBit (5CCR2_Add, 5) 

/*  Disable  idle  line  interrupt 

♦define  Disableldlelnt ( )  ClearBit (SCCR2_Add, 4 ) 

/*  Enable  idle  line  interrupt 

♦define  Enableldlelnt { )  SetBit (SCCR2_Add, 4) 

♦define  START_CHAR  (unsigned  char)  'S' 

♦define  STOP_CHAR  (unsigned  char)  's' 

/*  Command  Char  RXed  by  HC11  that  initiates  calc.  &  TX  of  posit,  values 
♦define  POS_REQ_COM_CHAR  (unsigned  char)  ' R' 

/*  Command  Char  RXed  by  HC11  that  preceeds  servo  control  values 
♦define  SER_REQ_COM_CHAR  'C' 

/*  Command  Char  TXed  by  HC11  that  preceeds  position  values 
♦define  POS_ACK_COM_CHAR  'P' 

/*  Command  Char  TXed  by  HC11  that  ack  receipt  of  servo  control  values 
♦define  SER_ACK_COM_CHAR  'A' 

/*  Command  not  yet  implemented*/ 

♦define  BAD_REQ_COM_CHAR  'x' 

♦define  START_CHAR_INDEX  0 
♦define  COM_CHAR_INDEX  1 

/*  12  position  bytes  *  6  values  +  4  handshaking  chars 
♦define  POS_ACK_STRING_LENGTH  16 
/*  1  start  char,  1  command  char,  &  1  stop  char 
♦define  SER_ACK_STRING_LENGTH  3 
/*  1  start  char,  1  command  char,  &  1  stop  char 
♦define  POS_REQ_STRING_LENGTH  3 

/*  10  servo  control  bytes  «  5  values  +  4  handshaking  chars 
♦define  SER_REQ_STRING_LENGTH  14 

/*  number  of  points  (0  included)  of  position  data 
♦define  POS  ACK^DATAJONLY  11 

/*  number  o?  poTnts  70  included)  of  servo  control  data 

♦define  SERJUBQJ3ATA_ONLY  9 

♦define  X_MSB  2  /*  index  of  pos  reply  chars  in  string  from  mcu  to  pc 

♦define  X_LSB  3 
♦define  Y_MSB  4 
♦define  Y_LSB  5 
♦define  Z_MSB  6 
♦define  Z_LSB  7 
♦define  ROLL_MSB  8 
♦define  ROLL  LSB  9 


7*0x53  upper  case  5 
/ *0x7 3  lower  case  s 
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♦define  PITCH_MSB  10 
♦define  PITCH_LSB  11 
♦define  YAW_MSB  12 
♦define  YAW_LSB  13 

♦  define  THROTTLE_MSB  2  /*  index  of  servo  control  request  O'irs 

♦define  THROTTLE_LSB  3  /*  in  string  from  oc  to  moo 

♦define  AILERON_MSB  4 
♦define  AIL£R0N_LS3  5 

♦  define  ELEVAT0R_MS3  6 

♦define  ELEVATOR_LSB  7 
♦define  RUDDER_MSB  8 

♦define  RUDDER_LSB  9 
♦define  COLLECTIVE_MSB  10 
♦define  COLLECTIVE_LSB  11 

/*  index  variables  */ 

unsigned  char  TXindex;  /*  index  of  char  to  be  TXed  in  the  buffer 

unsigned  char  RXindex;  /*  number  of  chars  which  have  been  received 

/*  TX  Buffers  for  HC11,  RX  Buffers  for  PC 
/*  position  values  ack  TX  buffer 
unsigned  char  PosAckBuf f [POS_ACK_STRING_LENGTHJ ; 

/*  servo  control  ack  TX  buffer 

unsigned  char  SerAckBuf f [SER_ACK_STRING_LENGTH] ; 

/*  RX  Buffers  for  HC11,  TX  Buffers  for  PC 
/*  Buffer  of  position  request 

unsigned  char  PosReqBuf f [POS_R£Q_STRING_L£NGTH] ; 

/*  Buffer  of  received  Data 

unsigned  char  SerReqBuf f (SER_REQ_STRING_LENGTH] ; 
unsigned  char  WorkSCSR;  /*  status  register  of  the  SCI 

unsigned  char  WorkRXdata;  /*  received  data  register 

unsigned  char  WorkCommandChar;  /*  Command  character  RXed  from  PC 

unsigned  char  ValidCommandChar;  /*  Most  recent  valid  command  rx'd 

unsigned  char  BadStopChar;  /*  char  rx'd  in  place  of  stop 

/*  Sephamores 

/*  TRUE  if  there  is  Noise, Framing  error  or  an  Overrun  error  * / 

unsigned  char  NoiseFraming; 

unsigned  char  Overrun; 

/*  TRUE  if  an  unknown  command  char  is  RXed  */ 

unsigned  char  UnknownCommandl ; 
unsigned  char  UnknownCommand2; 
unsigned  char  NoStopChar; 

unsigned  char  CheckSumBad;  /*  rx'd  bad  checksum  */ 

unsigned  char  IndexError;  /*  Indexing  Error  */ 

unsigned  char  RXstream;  /*  TRUE  implies  that  a  sequence  is  being  RXed  */ 

t*  TRUE  when  a  TX  should  take  place 

unsigned  char  AckWanted  ■  FALSE; 

unsigned  char  OC3triggered; 

unsigned  char  OC4triggered; 

unsigned  char  OCStriggered; 


/*-- - - - - - - — - - - - — - - - - ’/ 

/*  Byte  operation  variables  used  to  concatenate  and  cut  bytes  */ 

/* - .  / 


unsigned  char  LSBits; 

unsigned  char  MSBits;  /*  LSbits  or  MSbits  to  concat  or  results  «/ 

unsigned  int  Int_To_Split; 
unsigned  int  Concat_2B; 
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unsigned  char  PosOrSer  =  3AD_REQ_CCM_CHAR;  /*  Temp 


/  - - ----- - ----- 


VARIABLES  DEFINITION 


/*- - - - ---- 


VARIABLES  RELATIVE  TO  THE  INPU" 


:  A? TORE 


♦define  RX_RANK  2 
♦define  RX_NUM  ( RX_RANK+1 ) 
♦define  APM_CHAN_RANK  2 
♦define  NUM_IC  3 
♦define  NUM  PULSE  8 


/*  Rank  of  the 


used  for 


/*  Number  of  the  IC  used  £o: 
/*  rank  of  the  pulse  chat  g: 
/*  number  of  input  captures 
/*  Number  of  channels  to  re= 


/  *  the  synchronization  pulse  is  not 
♦define  TCNT_MAX_VAL  OxFFFF  /*  Maximum  value  of  the  main  15  bit 
♦define  OVERFLOW  MAX  VAL  OxFF/*  Maximum  value  of  the  8  bit  overfl 


/*  software  counter  (see  type  definition) 
♦define  SET_PIN  TRUE  /*  used  by  to  determine  next  state  of  outou 
♦define  CLEAR  PIN  FALSE  /*  ditto  */ 


/*  2  mhz,  500  ns  per  clock  cycle  of  timer,  so  2000  clock  cycles  »  I  ms 
♦define  ONE_MS  2000  /*  min  acceptable  time  between  two  RX  rising  edges  * 

♦define  ONE_POINT_TWO_MS  2400 
♦define  ONE_POINT_THREE_MS  2600 

♦define  ONE_POINT_FIVE_MS  3000  /*  Servo  Midpoint 

♦define  ONE~POINT_SEVEN_MS  3400 
♦define  ONE_POINT_EIGHT_MS  3600 

♦define  TWO_MS  4000  /*  max  acceptable  time  between  two  RX  rising  edges  * 

♦define  SOFTWARE_CORRECTION  0  /*  compensates  for  instruction 

execution  time  before  clearing  pulse 
number  of  500  ns  ticks  to  subtract 

♦define  INTER_PULSE_DURATION  4000  /*  arbitrary  delay  between  individual 

3ervo  pulses 

♦define  THROTTLE_LOWER_LIMIT  ONE_MS  /*  should  get  green  light 
♦define  THROTTLE_UPPER_LIMIT  TWO_MS  /*  should  get  red  light 
♦define  AILERON_LOWER_LIMIT  ONE_MS 
♦define  AILERON_UPPER_LIMIT  TWO_MS 
♦define  ELEVATOR_LOWER_L IMI T  ONE_MS 
♦define  ELEVATOR_UPPER_LIMIT  TWO_MS 
♦define  RUDDER_LOWER_LIMIT  ONE_MS 
♦define  RUDDER_UPPER_LIMIT  TWO_MS 

♦define  COLLECTIVE_LOWER_LIMIT  ONE_POINT_TWO_MS  /*  controls  bind 
♦define  COLLECTIVE  UPPER  LIMIT  ONE  POINT  SEVEN  MS  /*  controls  bind 


/*  default  3ervo  values  for  initialization 
♦define  THROTTLE_DEFAULT  THROTTLE_LOWER  LIMIT 
♦define  ELEVATOR_DEFAULT  ONE_POINT_FIVE~MS 

♦define  AILERON_DEFAULT  ONE_POINT_FIVE_MS 

♦define  RUDDER_DEFAULT  ONE_POINT_FIVE_MS 

♦define  TO_GTfRO_DEFAULT  ONE  POINT_FIVE_MS 

♦define  COLLECTIVE  DEFAULT  COLLECTIVE  LOWER  LIMIT 


♦define  NUM_PA  8 
♦define  NUM_PB  8 
♦define  NUM_OC  7 
♦define  MAX  SERVO  LABEL  5 


/*  number  of  pins  in  port  A  * 
/*  number  of  pins  in  port  3  * 
/*  number  of  output  compares  of  HC11  * 
/*  what  is  largest  number  of  servo  * 


/*  labels  are  for  indices  into  arrays  and  match  servo  assignments  on  rx 
/*  these  numbers  are  also  the  numbers  on  the  servo  output  block 
♦define  FROM_GYRO  0  /*  input  from  gyro  */ 
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♦  define  THROTTLE  1  /*  score  throttle  control  value  m  ?3' s  array  cos  1 

♦define  AILERON  2  /*  store  aileron  control  value  in  PA' s  array  cos  1 

♦define  ELEVATOR  3  /*  store  elevator  control  value  in  PB' s  array  pcs  1 

♦define  RUDDER  4  /*  store  rudder  control  value  in  PA' s  array  pcs  4 

♦define  TO_GYRO  5  /*  1.5  ms  pulse  always  to  gyro 

♦define  COLLECTIVE  6  /*  store  pitch  control  value  in  PA' s  array  pcs  6 


/*- - - - - - - - - - - - - 

/*  6811  Evaluation  Board  Hardware  Definitions 

- - - - - - - 

♦define  LATCH_SCI  0x4000  /*  address  of  flipflop  to  enable  RX 


/* 

/* . 

♦define 

♦define 

/*  pot 

♦define 

♦define 

♦define 

♦define 

♦define 

♦define 

♦define 

♦define 

♦define 


Stand  hardware  definitions 


LENGTH_ARM1  64 
LENGTH_ARM2  94 
number  match  A/D  block 
AZ_POT  0 

ROLL_POT  1 

EL_POT  2 

YAW_POT  3 

H_POT  4 

PITCH_POT  5 

SHOW  CAL_VALUE  6 
QUIT~VALUE  8 

EDIT  CAL  VALUE  7 


/*  length  of  lower  arm  in  centi 
/*  length  of  elevation  arm  in  c 
numbers  but  do  not  match  Port  E 
/*  pe  4  */ 

/*  PE  1  */ 

/*  PE  5  */ 

/*  PE  2  */ 

/*  PE  6  */ 

/*  PE  3  */ 

/*  used  by  FAMECAL.C  to  show 
/*  used  by  FAMECAL.C  to  ouit 
/*  used  by  FAMECAL.C  to  edit 


cal  vaJ 


/* - TYPE  DEFINITION . . 

- - - -  —  - - -  —  - - - - - - - - - 

/*  TimeMemo:  type  associated  to  each  input  capture  funct 

/* 

/*  Time [2]:  used  to  3tore  two  consecutive  values  of  the  IC 

/*  ie  time  of  capture  of  2  consecutive  edge 


type  associated  to  each  input  capture  function  IC 


register 


/*  OverflowCount :  software  8  bit  counter  to  count  the  number  of  main 
/*  timer  overflows  that  has  occur  between  the  capture  of  two 

/*  consecutive  edges  by  a  given  input  capture  pin 

typedef  struct 
( 

unsigned  int  Time [2]; 

unsigned  char  OverflowCount;  /*  software  overflow  counter  */ 

)  TimeMemo; 


TimeMemo  IC(NUM_IC] ; /*  Counter  overflow  &  array  to  save  time  for  each  IC  */ 
/*  Values  of  the  receiver  channels  belonging  to  the  same  frame  ’/ 
unsigned  int  PW_RX [NUM_PULSE]  ; 

unsigned  int  BUFF_RX[NUM_PULSE] ;  /*  Buffer  to  store  the  received  values  */ 


/* - - - - -  - — . */ 

/*  VARIABLES  RELATIVE  TO  THE  RECEIVER  INPUT  * ! 

/* - - */ 

/*  PWtempo:  When  two  successive  edge  have  been  detected  by  the  Input  */ 

/*  Capture  number  (i)  the  time  betweenn  them  is  computed  and*/ 

/*  and  stored  in  PWtempo [i-lj  */ 


unsigned  int  PWtempo [NUM_IC] ;  /*  array  of  PWtempo  for  each  input  capture*/ 

unsigned  char  PW_ReadtNUM_PULSE) ;  /*  PW_Read[i]  indicates  if  channel (i)  */ 

/*  has  been  already  read  */ 

unsigned  char  Synch;  /*  Set  when  the  system  is  synchronized  */ 
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unsigned  char  RXFirst 


unsigned  char  RX  Read; 


/"  Cleared  when  first  edge  is  ceteris 
/’  capture  has  been  enabled  again 
/*  Set  to  1  if  a  full  frame  has  ceer. 


/* - - - - - - - - ------ - - 

I*  VARIABLES  RELATIVE  TO  THE  OUTPUT  COMPARE  FUNCTION’S 

/*  Generates  signal  on  a  Port  A  pin  &  a  Port  3  pin  using  one  output 
/*  compare. 

/*  arrays  are  larger  than  necessary  so  that  output  block  numbers  car 
/ *  used  as  indices. 

/* - ------ - ~ - - - - ------ 

unsigned  int  ThighPA[NUM_PA+l] ; 

unsigned  int  ThighPB [NUM_P3+1 ] ;  /*  Buffer  to  store  time  high  for  ea; 
unsigned  int  AIndex; 
unsigned  int  BIndex; 

unsigned  int  ServoStatus [NUM  OC] ;  /*  remembers  which  servo  is  act: 


HC1 1  REGISTER  VARIABLES 


unsigned  int  *TCNT__Add; 
unsigned  char  *TMSK2_Add; 
unsigned  char  *TFLG2  Add; 


/*  main  timer  counter  registe: 
/*  main  timer  interrupt  mask 
/*  maintimer  flag  register 


unsigned  int  *IC_Add[NUM_lC] ;  /*  pointer  to  input  capture  registers, 
unsigned  int  *OC_Add[NUM_OC] ;  /*  pointer  to  output  compare  registers 


unsigned 

unsigned 

unsigned 

unsigned 

unsigned 

unsigned 

unsigned 


*TMSKl_Add 
*TFLGl_Add 
*TCTL2_Add 
*TCTLl_Add 
*0C1D  Add; 
*OClM_Add; 
*PACTL  Add 


/*  output  compare  and  input  capture  ir.t  masks'/ 
/*  output  compare  and  input  capture  flags 


/*  Output  1  control 


unsigned  char  *SCSR_Add; 
unsigned  char  *SCDR_Add; 
unsigned  char  *SCCR2_Add; 
unsigned  char  *SCCRl_Add; 
unsigned  char  *BAUD_Add; 
unsigned  char  *LATCH_SCI_Add; 


SCI  REGISTERS 


/*  status  register  of  the  SCI : flags  •/ 
/*  received  and  transmit  data  register  */ 
/*  interrupt  enables  and  state  of  SCI  v 
/*  data  format  8  or  9  bits  */ 
/*  baud  rate  register  *, 
/*  software  controllable  latch  to  connect 


pin  PDO  to  I/O  connector  */ 

/ * -  Port  A  &  B  registers:  for  sending  pulses  using  output  compare 

unsigned  char  *PORTB_Add; 
unsigned  char  *PORTA_Add; 


unsigned  char  *PORTD_Add; 
unsigned  char  *DDRD_Add; 
unsigned  char  *SPCR~Add; 


Port  D  registers  - 

/*  Port  D 

/*  Data  Direction  for  Port  D 
/*  SPI  Control  Register 


/*- - - - EEPROM  programming  registers  - - 

unsigned  char  *PPROG_Add;  I*  HC11  registers 

unsigned  char  * CONF I G_Add ; 
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/* 

/* - ~~~~ — . ~~ . 

double  PiOverTwo; 
double  PiOverFour; 
unsigned  char  *OPT10N_Add; 
unsigned  char  *ADCTL_Add; 
unsigned  char  *ADRl_Add; 
unsigned  char  *ADR2_Add; 
unsigned  char  *ADR3_Add; 
unsigned  char  *ADR4_Add; 


A/D  CONVERSION 


/*  compute  the  constant  for  later  cse 
/*  compute  the  constant  for  later  „se 
/’  HC11  registers 

/*  Control  Register  for  A/D  converter 
/*  loc  where  converted  values  are  stereo 


/*  Bit  patterns  written  to  ADCTL 
♦define  P£0to3_ADCTL  0x10  /* 

♦define  PE4to7  ADCTL  0x14  /« 


♦define 

PEO 

ADCTL 

0x00 

/* 

Value 

♦define 

PEI 

ADCTL 

0x01 

/* 

Value 

♦define 

PE2 

ADCTL 

0x02 

/* 

Value 

♦define 

PE3 

ADCTL 

0x03 

/* 

Value 

♦define 

PE4 

“ADCTL 

0x04 

/* 

Value 

♦define 

PE5 

ADCTL 

0x05 

/* 

Value 

♦define 

PE6 

ADCTL 

0x06 

/* 

Value 

♦define 

PE7' 

ADCTL 

0x07 

/* 

Value 

to  trigger  A/D  converters 
Scan»off,  Multiple  channel, 

Convert  Port  E  channels  0  chrcugr.  3 
Scan=off,  Multiple  channel. 

Convert  Port  E  channels  4  through  7 


to 

load 

ADCTL 

with 

to 

measure 

pin 

PEG 

to 

load 

ADCTL 

with 

to 

measure 

pin 

PEI 

to 

load 

ADCTL 

with 

to 

measure 

pin 

?E2 

to 

load 

ADCTL 

with 

to 

measure 

pin 

PE3 

to 

load 

ADCTL 

with 

to 

measure 

pin 

PE4 

to 

load 

ADCTL 

with 

to 

measure 

pin 

PE5 

to 

load 

ADCTL 

with 

to 

measure 

pin 

?E6 

to 

load 

ADCTL 

with 

to 

measure 

pin 

?E7 

/* - - - --- 

/*  variables  relative  to  the  position  determination 

/*. — - - - - - - - 

/*  Stand  potentiometer  angles  used  to  determine  the  Cartesian  location 
double  anglelz; 
double  angle2z; 
double  angle2x; 

/*  Potentiometer  angles  used  to  determine  the  rotational  location 
double  angle3pitch; 
double  angle3roll; 
double  angle3yaw; 

/*  First  Voltage  from  AD  converter 

unsigned  char  V3pitch0; 

unsigned  char  V3roll0; 

unsigned  char  V3yaw0; 

unsigned  char  V2z0; 

unsigned  char  V2x0; 

unsigned  char  VlzQ; 

/*  Second  Voltage  from  AD  converter 

unsigned  chaz  V3pitchl; 

unsigned  chaz  v3rolll; 

unsigned  chaz  V3yawl; 

unsigned  chaz  V2zl; 

unsigned  char  V2xl; 

unsigned  char  VI zl; 

♦define  DLY10  0x4E40  /*  delay  of  10  ms  in  term  of  main  timer  cycle 

/*  Global  variables  used  to  cut  Double_To_Split  into  4  unsigned  char 
unsigned  char  ByteQ; 
unsigned  char  Bytel; 
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unsigned,  char  3yte2; 
unsigned  char  Byte 3; 
double  Double_To_Split ; 

/*  Cartesian  position  of  the  Helicopter 
int  Xcord; 
int  Ycord; 
int  Zcord; 

/*  rotational  position  of  the  Helicopter 
int  Roll; 
int  Pitch; 
int  Yaw; 

/*  constants  relative  to  coordinate  conversion  and  scaling  for  t:< 
double  RadiansToDegrees; 
double  AngleTxScaleFactor; 
double  PositionTxScaleFactor ; 

/* - .... - - - 

/*  variables  for  retrieving  calibration  values  from  ohe  EEPROM 

I* . 

/*  EEPROM  Slope  values 
double  *Slopelz_Add; 
double  *Slope2z_Add; 
double  *Slope2x_Add; 
double  *Slope3pitch_Add; 
double  *Slope3roll_Add; 
double  *Slope3yaw_Add; 

/*  EEPROM  DC  offset  voltage  values 
unsigned  char  *Vlz0_Add; 
unsigned  char  *V2x0_Add; 
unsigned  char  *V2zO_Add; 
unsigned  char  *V3pitchO_Add; 
unsigned  char  *V3rollO_Add; 
unsigned  char  *V3yawO_Add; 

/*  EEPROM  addresses  of  calibration  values  for  potentiometers 


♦define  SLOPElz_ADDRESS  0x7fll 

♦define  Vlz_ADDRESS  0x7fl5 

♦define  SLOPE2x_ADDRESS  0x7f21 

♦define  V2x_ADDRESS  0x7f25 

♦define  SL0PE2z_ADDRESS  0x7f31 

♦define  v2z_ADDRESS  0x7f35 

♦define  SLOPE3pitch_ADDRESS  0x7f41 

♦define  V3pitch_ADDRESS  0x7 f 45 

♦define  SLOP*3roll_ADDRESS  0x7f51 

♦define  V3roll_ADDR£SS  0x7f55 

♦define  SLOPE3yaw_ADDRESS  0x7 f 61 

♦define  V3yaw_ADDRESS  0x7 f 65 
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/*  Declaration  of  the  Hll  register 
/*  c:\introl\kjh\kjhstart.oll 

addresses  defined  in  the  library 

extern 

unsigned 

char 

H11P0RTA; 

I* 

i/o  port  A 

extern 

unsigned 

char 

H11PI0C; 

/* 

parallel  i/o  centre,  reoiste. 

extern 

unsigned 

char 

H11P0RTC; 

/* 

i/o  oort  C 

extern 

unsigned 

char 

H11P0RTB; 

/* 

i/o  port  B 

extern 

unsigned 

char 

HliPORTCD; 

/* 

alternate  latch  oort  C 

extern 

unsigned 

char 

H11DDRC; 

/* 

data  direction  for  oert  C 

extern 

unsigned 

char 

H11P0RID; 

/* 

i/o  port  D 

extern 

unsigned 

char 

H11DDRD; 

/« 

i/o  data  direction  for  sort 

extern 

unsigned 

char 

H11P0RTE; 

/* 

i/o  port  D 

extern 

unsigned 

char 

H11CFGRC; 

/* 

compare  force  register 

extern 

unsigned 

char 

H110C1M; 

/* 

0C1  action  mask  register 

extern 

unsigned 

char 

H110C1D; 

/* 

0C1  action  data  register 

extern 

unsigned 

int 

H11TCNT; 

/  * 

timer  counter  register 

extern 

unsigned 

int 

H11TIC1 ; 

/* 

input  capture  register  1 

extern 

unsigned 

int 

H11TIC2; 

/* 

input  capture  register  2 

extern 

unsigned 

int 

H11TIC3; 

/* 

incut  capture  regisi er  3 

extern 

unsigned 

int 

H11T0C1; 

/' 

output  compare  register  1 

extern 

unsigned 

int 

411T0C2; 

/* 

output  compare  register  2 

extern 

unsigned 

int 

H11T0C3; 

/* 

output  compare  register  3 

extern 

unsigned 

int 

411TOC4/ 

/* 

output  compare  register  4 

extern 

unsigned 

int 

H111T0C5; 

/* 

output  compare  register  5 

extern 

unsigned 

char 

H11TCTL1; 

/* 

timer  control  register  1 

extern 

unsigned 

char 

H11TCTL2; 

/* 

timer  control  register  2 

extern 

unsigned 

char 

H11TMSK1 ; 

/* 

main  timer  interrupt  mask  1 

extern 

unsigned 

char 

H11TFLG1 ; 

/* 

main  timer  interrupt  flag  1 

extern 

unsigned 

char 

H11TMSK2; 

/* 

main  timer  interrupt  mask  2 

extern 

unsigned 

char 

H11TFLG2; 

/* 

mi sc  timer  interrupt  flag  2 

extern 

unsigned 

char 

H11PACTL; 

/* 

pulse  acc  control  register 

extern 

unsigned 

char 

H11PACNT; 

/* 

pulse  acc  count  register 

extern 

unsigned 

char 

H11SPCR; 

/* 

SPI  control  register 

extern 

unsigned 

char 

H11SPSR; 

/* 

SPI  status  register 

extern 

unsigned 

char 

H11SPDR; 

/* 

SPI  data  in/out 

extern 

unsigned 

char 

Hll BAUD; 

/* 

SCI  baud  rate  control 

extern 

unsigned 

char 

H11SCCR1; 

/* 

SCI  control  register  1 

extern 

unsigned 

char 

H11SCCR2; 

/* 

SCI  control  register  2 

extern 

unsigned 

char 

H11SCSR; 

/* 

SCI  status  register 

extern 

unsigned 

char 

H11SCDR; 

/* 

SCI  data 

extern 

unsigned 

char 

H11ADCTL; 

/* 

A  to  D  control  register 

extern 

unsigned 

char 

H11ADR1; 

/* 

A  to  D  result  1 

extern 

unsigned 

char 

H11ADR2; 

/* 

A  to  D  result  2 

extern 

unsigned 

char 

H11ADR3; 

/* 

A  to  D  result  3 

extern 

unsigned 

char 

H11ADR4; 

/* 

A  to  D  result  4 

extern 

unsigned 

char 

H110PTI0N; 

/* 

System  configuration  options 

extern 

unsigned 

char 

HI 1COPRST; 

/* 

arm  /reset  COPtimer  circutry 

extern 

unsigned 

char 

H11PPRGG; 

/* 

EEPROM  programming  control 

extern 

unsigned 

char 

HI 1HPRI0; 

/* 

highest  priority  I  bit  and  m 
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extern  unsigned  char  Hi  UNIT;  /»  RAM  /io  mapping  register 

extern  unsigned  char  H11TE3T1;  /*  factory  test  centre. 

/ *  CO?/  ROM,  &EEPRCM  er.acl^s  * 

extern  unsigned  char  HllCONFIG; 


/*****★★******************»***«**«*******************•**»*  *  *  *  «  *  *  *  *  c»* 

/*  PROTOTYPES 

/**********x*****************#*:v**********************«***r  *  «  *  *  *  r  *  ar  «  * 

/*  functions  for  measuring  pots  and  calculating  positions  a no  angles 

void  InitADconverter (void) ; 

void  MeasureAngles (void) ; 

void  PositionDetermination (void)  ; 

/*  functions  used  for  both  TX  &  RX 

void  SCI_ISR(void) ;  /*  ISR  for  transmission  or  reception  over  3CI 

unsigned  char  Checksum(int  maxnum,  unsigned  char  CheckAr ray ( i ) ; 

/*  Transmission  /  Acknowlegement  prototypes 
void  SCI_init_TX (void) ;  /*  initializes  TX  to  PC 

void  SCI_TX_ISR (void) ;  /*  ISR  that  transmits  position  values  to  ? 

void  TXf irst (void) ; 

void  FillPosAckBuf f (void) ; 

void  FillSerAckBuf f (void) ; 

void  Split_Int (int  i) ;  /*  function  that  calls  asm  function  below 

void  split_int (void) ;  /*  assy  lang  to  prepare  pos  values  for  TX  t 

/*  Reception  of  Position  value  requests  &  servo  control  requests 
void  SCI_init_RX (void) ;  /*  initialize  for  reception  over  SCI 

void  SCI_RX_ISR (void) ;  /*  ISR  that  receives  and  stores  characters 

void  ReinitializeReceive (void)  ; 

void  SaveReg (void) ;  /*  reads  RX  buffers  &  saves  values  to  work  regis 
void  RXerror (void) ; 
void  CharRX (void) ; 

void  CompleteRXstream(void) ;  /*  verify  that  checksum  is  vaiid  S  sto 

servo  control  data  in  array 
/*  function  to  call  asm  routine  below 

int  Concat_Int (unsigned  char  MSbits, unsigned  char  LSbits) ; 

/*  asm  routine  for  concatenating  servo  control  values 
void  concat_int (void) ; 
void  ClearWorkVar (void) ; 

/*  Servo  Control  Prototypes 
void  InitOC(int  OCnum,  int  Enable); 
void  DecodeAndStoreServoString (void) ; 
void  InitServos (void) ; 

void  SendPul*«PA_PB (int  OCnum,  int  PAnum,  int  PBnum) ; 
void  OC3_ISR(void) ; 
void  OC4_ISR(void) ; 
void  0C5_ISR(void) ; 

void  InitOverf low (void) ;  /*  enables  ISR  below 

void  TCNT_Overf low (void) ;  /*  ISR  counts  number  counter  overflows 

/*  functions  for  doing  basic  bit  operations  on  register  settings 
void  InitializeConstantVariables (void) ; 
void  InitializeVectorTable (void) ; 
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void  InitPointer (void)  ; 

void  CiearBit  (unsigned  char  "pointer,  ;n:  NuirBit)  ; 
void  ClearFlag (unsigned  char  "pointer, int  NuriBic >; 
void  SetBit (unsigned  char  ’pointer, int  NunSit ) ; 
unsigned  char  GetBit (unsigned  char  ’points 
unsigned  char  GetBit__Char  (unsigned  char  re 
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/*  George  Mason  University 

/*  Department  of  Electrical  and  Computer  Eng. 

/  * 

/*  File  Name:  FAMEmain.C 
/  * 


/*  Authors:  Berti.na  Ho-.Mock-Qai ,  Darrell  Duane,  Her. 
/*  Update  History:  Version  1.0,  February  23,  1392 
/* 

/*  ***  indicates  functions  and  their  prototypes 
/*  -  indicates  ISRs 


/* 

/•ft**************************-*##******##*************** 

♦include  "c: \introl\k jh\KJHSTDIO. h” 


♦include 

♦include 

♦include 

♦include 

♦include 


" c : \ int  rol \ i nci ude \MATH . h " 
"c: \introl\dd8\F AMEDEF . H" 
"c: \ int  rol \dd8 \ FAMELIB . c” 
"c:\int  rol\dd8 \ FAME IN IT . c ” 
"c:\introl\dd8\FAMEISR.c" 


/x*#*******#iir*****ir*x-******wirxir*x***-********x*»***x*ir*trir»'r'rw*»** 

/*  resets  receive  indices  and  initializes  rx  interrupts 

/x**#****jirXX**********iir******xX**X**#*X#ir******»*****irX«X*  **»*■»» 

void  ReinitializeReceive (void) 


( 

RXindex  ■  0; 

RXstream  ■  FALSE; 

EnableRXint ( ) ; 

Checks umBad  ■  FALSE; 

) 


/*  reset  index  */ 

/*  Enable  RX  interrupts  */ 


//**********************************^)H)****#*#*********t***t«***t 

/*  Function  to  initialize  the  different  reception  variables 

/************************************«r***********************w»* 

void  ClearWorkVar (void) 

( 

int  i; 

WorkCornmandChar»0 ; 

/*  clear  servo  control  request  buffer 
for ( i  *  0;  i  <  SER_REQ_STRING_LENGTH;  i++) 

{ 

SerReqBuf f [i] -0; 

} 

/*  clear  entire  position  value  request  buffer 
for ( i  «  0;  i  <  POS_REQ_STRING_LENGTH;  i++> 

( 

PosReqBuf f [ i J -0 ; 

} 

) 
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/*  tuac::on  called  when  a  ccrr. piece  serve  ccnrrcl  sequence  r.as  teen  r.:'  u  • 
/*  verifies  checksum  correct,  cf  yes  ::  calls  StoreDana,  men  me 
/*  servo  controls  are  output  to  the  Cutout  Compare  pms 
/*  only  called  when  servo  control  request  values  ?:<ec  free.  ?c 

/»*****#*»**  #'»★*«»**#**»■*»**»•»***  **K**-«f**ir****  *»••*«-*■*»**  cr  *  *  «  *  m  «  .  «  »  -  «  •  *  *  • 

cid  DecodeAndStoreServcStrir.g  (void) 


unsigned  int  LocalUI; 

C.  sableRXint () ; 

L.  -alUI  =  Concat  Int (SerReqBuff [TKRCTTL£_MS3]  , 

SerReqBuff [THRQTTLE_LSB]  )  ; 

if  (  (Locaiui  >-  throttle_lcwer_limit> 

&& (LocalUI  <*  THROTTLE_U?PER_LIMIT) ) 

( 

ThighPB [THROTTLE]  =  LocalUI; 

) 

LocalUI  =  Concat  Int (SerReqBuff [AILERCN_MSB] , 

SerReqBuff [AIL£RON_LSBj ) ; 

.f  (  (LocalUI  >-  AILERON_:  :'JER_LIMIT) 

&& (LoCo-JI  <-  AILERON_  .  ?ER_LIMIT)  ) 

{ 

ThighPA [A  *  1ERON]  =  LocalUI; 

} 

LocalUI  =  Concat  Int (SerReqBuff [SLEVATOR_MSB] , 

SerReqBuff [ELEVATOR_LSB] ) ; 
if  (  (LocalUI  >-  ELEVATOR_LOWER_LIMIT) 

&& (LocalUI  <=  ELEVATOR_UPPER_LIMIT) ) 

( 

ThighPB [ELEVATOR)  -  LocalUI; 

) 

LocalUI  *  Concat  Int (SerReqBuff [RUDDER_MSB] , 

SerReqBuff [RUDDER_LSB1 )  ; 
if  <  (LocalUI  >=  RUDDER_LOWER_LIMIT) 

&& (LocalUI  <*  RUDDER_UPPER_LIMIT) ) 

{ 

ThighPA [RUDDER]  »  LocalUI; 

) 

LocalUI  -  Concat_Int (SerReqBuff [COLLECTIVE_MSB]  , 

SerReqBuff [COLLECTIVE_LSB] ) ; 
if  (  (LocalUI  >-  COLLECT I VE_LOWER  LIMIT) 

6S (LocalUI  <-  COLLECTIVE_UPPER_LIMIT) ) 

( 

ThighPA [COLLECTIVE]  -  LocalUI; 

“ -initializeReceive  () ; 

,  .  *  end  function  Complete  RX  stream  */ 


i 


i 


t 


i 


4 


I 


< 
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/*****«*****w*»*********************«*****jr***«w***jr*n****w«>r*  (iriK,,  «  *  *  > 

/*  Function  called  after  a  complete  position  request  sequence  is  received 
/*  It  triggers  the  A/D  converters  to  sample  the  potentiometers  angles, 

/*  and  fills  the  TX  buffer  with  the  measured  values. 

/**********'**-********-****»***«ir*X**************W***#*****wir»*wit*irw**wiririr.r 

void  FillPosAckBuf f (void) 

{ 

MeasureAngles ( ) ;  /*  trigger  A/D  conv.,  &  measure  all  angles  * 

PositionDetermir.ation  ( )  ; 

PosAckBuf f [5TART_CHAR_INDEX]  =  START_CHAR; 

PosAckBuf f [COM_CHAR_INDEX]  =  POS_ACK_CCM_CKAR; 

PosAckBuf f [POS_ACK_STRING_LENGTH  -  1]  =  STOPjEHAR; 

Split_Int (Xcord) ;  /*  send  X  cartesian  coordinate  of  helicopter  to  PI  * 

PosAckBuf f[X_MSBJ  -  MSBits; 

PosAckBuf f[X_LSB]  =  LSBits; 

Split_Int (Ycord) ;  /*  send  Y  cartesian  coordinate  of  heiicccter  to  PC  * 

PosAckBuf f [Y_MSB]  =  MSBits; 

PosAckBuf f[Y_LSB]  =  LSBits; 

Split_Int ( Zcord) ;  /*  send  Z  cartesian  coordinate  of  helicopter  tc  PC  ' 

PosAckBuf f[Z_MSB]  *  MSBits; 

PosAckBuf f [Z_LSB]  =  LSBits; 

Split_Int (Roll) ;  /*  send  roll  to  PC 

PosAckBuf f[ROLL_MSB)  »  MSBits; 

PosAckBuf f[ROLL_LSB]  -  LSBits; 

Split_Int  (Pitch) ;  /*  send  pitch  to  PC 

PosAckBuf f[PITCH_MSB]  -  MSBits; 

PosAckBuf f[PITCH_LSB]  -  LSBits; 

Split_Int (Yaw) ;  /*  Send  yaw  to  PC 

PosAckBuf f[YAW_MSB]  -  MSBits; 

PosAckBuf f[YAW_LS3]  =  LSBits; 

/*  Calculate  checksum  */ 

PosAckBufffPOS  ACK_STRING_LENGTH  -  2] 

=  Checksum (POS_ACK_STRING_LENGTH,  PosAckBuff) ; 

} 


/ft*********************************************************************** 

/*  Calculates  X,Y,Z  positional  &  rotational  coordinates  using  the 
/*  values  read  from  the  A/D  converters  which  measure  the  potentiometers. 
/*  double  precision  numbers  from  positions  are  scaled  before  converting 
/*  to  integer  before  transmission.  The  position  scale  factor  can  be  fou 
/*  in  FAMEDEF.h  as  POSITION_TX_SCALE_FACTOR. 

/*  The  same  goes  for  angles  except  they  are  converted  to  degrees  also  an 
/*  their  scaling  factor  is  ANGL£_TX_SCALE_FACTOR . 

/  1r  *  it  it  It  It  It  ±  It +  +  **  + It  *  It  1r  *  It  ***  il  *  + ii  It  **  It  it  It  *****  It  It  *********  it  It  It  it  **************  * 

void  PositionDetermination (void) 

1 

double  d; 

d  «  (double) LENGTH_ARM1  *  cos(anglelz) 

+  (double) LENGTH_ARM2  *  cos(anglelz  +  angle2z)  *  cos (angle2x) ; 

Xcord  -  (int) (PositionTxScaleFactor  *  d) ; 
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d  =  (double) LENGTH_ARM1  *  sin  (ar.gielz) 

+  (double)  LENGTH_ARM2  *  (sir.  (ar.gielz  f  ar.gle2z))  *  zcs  ( ar.gleix i  . 
Ycord  =  (int)  (PositionTxScaieFactor  *  d) ; 
d  =  (double)  LENGTH_i_ARM2  *  sin  (angle2x)  ; 

Zcord  =  (int) (  PositionTxScaieFactor  *  d) ; 

Pitch  *  (int)  (  RadiansToDegrees  ’  AngleTxScaleFactor  *  an gie3pit rh; 
Roll  =  (int)  (  RadiansToDegrees  *  AngleTxScaleFactor  *  angle3roil; ; 
Yaw  *  (int)  (  RadiansToDegrees  *  (angle3yaw  +  angle! z  r  ar.gielz) 

*  AngleTxScaleFactor  )  ; 

}  /*  end  function  PositionDetermination  */ 


/***-************-*#***********lt*********’********’*****ir************w*  »  r  r  n  m  *  w 

/*  Function  that  calculates  the  angles  measured  by  the  potentiometers 
/*  Measure  values  of  A/D  converters  for  cartesian  location  calc. 
/***********************«**»************»»*******»***»**»*»»»»»«***»»*««-« 
void  MeasureAngles (void) 

{ 

/*  convert  voltages  measured  on  pins  PE4  through  PE7 
*ADCTL_Add  *  PE4to7_ADCTL; 

while (GetBit (ADCTL_Add, 7) ==0) ;  /*  wait  for  conversion  to  complete  ’/ 

/*  Calibration  of  the  cartesian  angle  values  using  the  EEPRCM  coefficients 
anglelz  =  (  (double) *Slopelz_Add  * 

(double) ( (int) *ADR3_Add  -  (int) *VlzO_Add)  ); 
angle2x  -  (  (double) *Slope2x_Add  * 

(double) ( (int) *ADR2_Add  -  (int) *V2xO_Add)  ); 
angle2z  »  (  (double) *Slope2z_Add  * 

(double) ( (int) *ADRl_Add  -  (int ) *V2zO_Add)  ); 

*ADCTL_Add«PE0to3_ADCTL;  /*  convert  voltages  measured  on  pins  PEG 

through  PE3  */ 

while (GetBit (ADCTL_Add, 7) —0) ;  /*  wait  for  conversion  to  complete  */ 

/*  Calibration  of  the  rotational  angle  values  using  the  EEPROM  coefficients 
angle3pitch  -  (  (double) *Slope3pitch_Add  *  (double) ( (int ) *ADR4_Add 

-  (int) *v3pitch0  Add)  ); 

angle3roll  »  (  (double) *Slope'5roll_Add  *  (double) ( (int) *ADR2_Add 

-  (int) *V3rollO_Add)  ); 

angle3yaw  »  (  (double) *Slope3yaw_Add  *  (double) ( (int) *ADR3_Add 

-  (int) *V3yawO_Add)  ); 

)  /*  end  of  function  ConvertAD  */ 

/*  TXes  the  first  char  of  the  TX  buffer,  which  spawns  the  TX  of  the  rest  */ 
/*  of  the  buffer.  */ 

/***********************************************************************»*/ 
void  TXfirst (void) 

( 

TXindex  -  0 ; 

*SCSR_Add  *  *SCSR_Add;  /*  TORE  flag  cleared  after  function  writes  to  TDR  * 

switch (ValidCoamandChar) 

( 

case  POS_REQ_COM_CHAR : 

*SCDR_Add  *■  PosAckBuf f (TXindex)  ; 

/*  Write  to  the  TDR  &  clear  TORE  flag  */ 
EnableTXbuffEmptylnt () ;  /*  enable  transmit  complete  interrupt 
macro  */ 

break; 

case  SER  REQ  COM  CHAR: 
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macro 


*SCDR_Add  «  SerAckBuf f [TXindex]  ; 

/*  Write  u  the  TDR  &  clear  TORE  flag  */ 

EnableTXbuf f Empty Int  (}  ;  /*  enable  transmit  comcle'e  -- 

*/  ' 

break; 

default : 

print f ( "Attempt  to  TX  unknown  type  in  TXfirst (i  r") ; 
oreak; 

)  /*  end  switch!)  */ 

/*  The  next  value  that  should  be  sent  by  the  ISR  will  have  an  index  =  • 

(  /*  end  TXfirst  */ 


/*  Main  function  to  receive  a  character  according  to  the  control  wcr 
/*  the  corresponding  functions  are  called,  2  possible  sequences  car. 

/*  received  "position  sequence"  and  the  "servo  control  sequence" 

void  CharRX(void) 

( 

if  (RXindex  =*”  START_CHAR_INDEX)  /*  Determine  command,  start  oniy  rx' d  *, 

( 

RXindex++; 

WorkCommandChar  *  WorkRXdata;  /*  WCC  used  for  further  character  routing*/ 
switch (WorkCommandChar) 

{ 

case  POS_REQ_COM_CHAR:  /*  is  this  a  position  request?  */ 

PosReqBuff  [RXindex)  -  WorkRXdata;  /*  Store  comrr-iand  char  */ 
break; 

case  SER_REQ_COM_CHAR:  /*  is  this  servo  control  request?  */ 

SerReqBuff [RXindex]  -  WorkRXdata;  /*  Store  command  char  for  Checksum  * 
break; 

default:  /*  is  this  an  unknown  request?  */ 

UnknownCommandl  *  TRUE; 

RXindex  -  0; 

RXstream  »  FALSE; 
break; 

)  /*  end  switch ()  for  command  character  */ 

}  /*  end  if  this  is  the  command  character  */ 

else  /*  any  character  other  than  the  start  char  or  command  char  */ 

f 

RXindex++; 

switch (WorkCommandChar) 

{ 

case  POS_REQ_COM_CHAR:  /*  is  this  a  position  request  (no  data)?  */ 
if (  (RXindex  --  (COM_CHAR_INDEX+l ) ) 

&&  (WorkRXdata  ST0P_CHAR)  )  /*  is  thi3  the  stop  char?  */ 

( 

ValidCommandChar  *  WorkCommandChar; 

AckWant«d*TRUE;  /*  set  sephamore  to  trigger  acknowledgement  to  PC  * 

}  /*  disable  rx  inter  */ 

else  /*  error  */ 

printf("No  stop  character  in  position  request  \r"); 

ReinitializeReceive () ; 
break; 

case  SER_REQ_COM_CHAR:  /*  is  this  servo  control  sequence  (need  data)?  */ 
if (  (RXindex  >  COM_CHAR  INDEX) 

&& (RXindex  <  (SER_REQ_STRING_LENGTH  -  1>>)  /*  All  but  Stop  char*/ 
l 

SerReqBuff [RXindex]  -  WorkRXdata; 
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I  /*  save  servo  control  or  checksum  values  to  this  array  v 
else  if(RXindex  ==  SER_REQ_STRING  LENGTH  -  1)  /*  RX INDEX  ->  STD? 

( 

if (WorkRXdata  ==  STOP_CHAR)  /•  is  it  the  stop  char?  */ 

{ 

SerReqBuf f [RXindex]  *  WorkRXdata; 
if (SerReqBuf f [SER_REQ_STRING_LENGTH  -  2) 

=»  Checksum (SER_REQ_STRING_LENGTH,  SerReqBuff) ) 

{  /*  and  checksum  CK 

ValidCommandChar  =  WorkCommandChar; 

AckWanted  -  TRUE;  / *  Let  foreground  know  new  comma re  * 

} 

else 

{ 

CheckSumSad  =  TRUE; 

ReinitializeReceive ( )  ; 

1 

NoStopChar  »  FALSE; 

)  /*  disable  RX  while  TXing  ack  */ 

else  /*  error  */ 

( 

NoStopChar»TRUE; 

BadStopChar  *  WorkRXdata; 

ReinitializeReceive { )  ; 

} 

} 

/•else*/  /*  indexing  error  */ 

/*  { 

IndexError-TRUE; 

NoStopChar  -  FALSE; 

ReinitializeReceive ( ) ; 

}*/ 

break; 

default:  /*  is  this  an  unknown  request?  */ 

UnknownCommand2  «  TRUE; 

ReinitializeReceive () ; 
break; 

}  /*  end  switch {)  */ 

}  /*  end  else  this  is  not  the  Command  Char  */ 

}  /*  end  of  function  CharRX  */ 


/****■**********************************************«*«*********»**»»*»»»», 
/*  Main  68EVB  FAME  program 

/ft**********************************************************************, »» 

int  main() 

{ 

a3m{"disint  SEI\nn ) ;  /*  disable  global  interrupt  of  HCli  * 

InitializeConatantVariables () ; 

InitializaVactorTable () ;  /*  init  ISR  jump  table  in  RAM  * 

InitPointer () ;  /*  Initialize  values  of  pointers  to  HC11  registers  * 

InitServos () ;  /*  initialize  durations  for  high  &  low  values 

output  compares  (servo  control) 

InitADconverter () ;  /*  initialize  OPTION  register  for  A/D  converters  * 

ClearWorkVar () ;  /*  Initialize  the  communication  buffers 

InitOC <0C3_NUM,  TRUE);  /*  initialize  Output  Compare  #3  set  time=Q, 

clear  flag,  enable  interrupt 
InitOC (0C4_NUM,  FALSE);/*  ditto  for  #4,  no  enable 
InitOC (0C5_NUM,  FALSE);/*  ditto  for  #5,  no  enable 
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SCI_init_TX ( ) ;  /*  Initialize  the  SCI  transmitter 

SCI_init_RX ( )  ;  /*  initialize  the  SCI  receiver 

asmC'inter  CLI\n");  /*  enable  global  interrupt  of  HC11 
while  (TRUE)  /*  endless  Iood  awaiting  ISRs  5  serr.aohores  *  / 

{ 

if (Overrun) 

( 

Overrun=FALSE; 
printf  ("Overrun\r")  ; 

} 

if (NoiseFraming) 

( 

NoiseFram.ing=FALSE; 
printf { "Noise/Framing\ r" )  ; 

I 

if (UnknownCommandl ) 

( 

UnknownCommandl “FALSE; 

printf ( "Unknown  Command  1  Char  RXed  from  PC\r"); 

I 

if (UnknownCommand2 ) 

{ 

UnknownCommand2-FALSE; 

printf ( "Unknown  Command  2  Char  RXed  from  PC\r"); 

) 

if (NoStopChar) 

{ 

NoStopChar*FALSE; 

printf ("Character  RXed  where  stop  char  expected  not  a  stop  char.Xr"); 
printf ("Character  RXed  instead  »  %c  \r”,  BadStopChar) ; 

) 

if (IndexError) 

{ 

I ndexE  r r o  r-FALSE ; 
printf ("Index  Error\r") ; 

} 

if (OC3triggered) 

{ 

0C3triggered“FALSE; 

} 

if (OC4triggered) 

{ 

OC4triggered»FALSE; 

} 

if (OCStriggered) 

( 

OC5triggered«FALSE; 

) 

if (AckWanted) 

( 

putchar (' A* ) ;  /* (int) 0x41 ) ;  A  */ 

putchar (* ! * ) ;  /* (int) 0x21) ;  !  */ 

AckWanted  ■  FALSE;  /*  Reset  Semaphore  */ 
switch (ValidCommandChar) 

{ 

case  POS_REQ_COM_CHAR:  /*  Set  Sephamore  to  TX  Position  Values  Request 

Acknowledgement  * / 

FillPosAckBuf f  () ;  /*  Fill  the  TX  buffer  with  the  position  values  */ 

TXfirst (> ; 

ReinitializeReceive ( ) ; 
break; 
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cass  SER _ Rc-Q _ COM _ CHAR:  /*  Sec  Seohamore  rc 

Acknowledgement  */ 

DecodeAndStoteServoString ( ) ; 

FillSerAckBuff () ;  /*  rill  the  TX  buffer  with 

TXfirst  <) ; 

ReinitializeReceive ( )  ; 
break; 
default : 

printf ("Invalid  Acknowlegement  type  requested. 

ReinitializeReceive ( )  ; 

break; 

)  /*  end  switch  */ 

)  /*  end  if  AckWanted  */ 

}  /*  while  true  */ 

)  /*  main  routine  */ 
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/*  George  Maser.  University 

/*  Department  of  Electrical  and  Computer  Engineering 

/  * 

/*  File  Name:  FAMEINIT . C 
/* 

/*  Authors:  Bertina  Ho-Mock-Qai,  Darrell  Duane,  Ken  Hints 
/*  Update  History:  Version  1.0,  February  23,  1992 
/* 

/  *  * 

/*************************»r***********,r*«t*****1r****iir*,r***Jr**,rir  r  *  *  *  ,  *  *  «■  «■  ,  w  ,  ,  , 

/*  Initializes  some  constants  so  that  they  do  not  have  to  be  computed 
/*  repeatedly  during  program  execution 

void  InitializeConstantVariables (void) 

( 

PiOverTwo  *  PI  /  2.0; 

PiOverFour  -PI  /  4.0; 

RadiansToDegrees  -  RADIANS_TO_DEGREES; 

AngleTxScaleFactor  =  ANGLE_TX_SCALE_FACTOR;  /»  scaled  integers  are  sent*/ 
PositionTxScaleFactor  -  POSITION_TX  SCALE  FACTOR; 

} 

/*************************************1t*1t******1t**1tiii,i,1,1,1,r,^l,i,l,i,i,1,wwi,xi>in,^lri,^ 

/»  Not  Complete,  add  vectors  as  needed 
void  InitializeVectorTable ( void) 


{ 

unsigned  char  *TempPointer; 

/*  Vector  to  SCI  ISR  */ 

TempPointer  -  (unsigned  char  *)VSCI; 

♦TempPointer  -  (unsigned  char)  JUMPEXTENDED; 

♦(TempPointer  +  1)  - 

(unsigned  char)  ( (OxffOO  &  ((unsigned  int) (&SCI_ISR) ) )  >>  3) ; 
♦(TempPointer  +  2)  - 

(unsigned  char)  (OxOOff  &  ((unsigned  int) (SSCI_ISR> 1 ) ; 


/♦  Vector  to  OC3  ISR  */ 

TempPointer  -  (unsigned  char  *)VTOC3; 

♦TempPointer  -  (unsigned  char)  JUMPEXTENDED; 

♦(TempPointer  +  1)  - 

(unsigned  char)  ((OxffOO  4  ((unsigned  int) (40C3_ISR) ) )  >>  3) 
♦(TempPointer  +  2)  - 

(unsigned  char)  (OxOOff  4  (unsigned  int)  (40C3_ISR)  )  ; 

/♦  Vector  to  OC4  ISR  */ 

TempPointer  -  (unsigned  char  *)VTOC4; 

♦TempPointer  -  (unsigned  char)  JUMPEXTENDED; 

♦(TempPointer  +1)  » 

(unsigned  char)  ((OxffOO  &  ((unsigned  int)  <40C4_ISR) ) )  >>  3) 
♦(TempPointer  +  2)  - 

(unsigned  char)  (OxOOff  &  (unsigned  int)  (&OC4_ISR)  >; 

/*  Vector  to  OC5  ISR  */ 

TempPointer  -  (unsigned  char  *)VTOC5; 

♦TempPointer  -  (unsigned  char)  JUMPEXTENDED; 
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* 


* 


} 


(TempPointer  +  1)  = 

(unsigned  char) 
(TempPointer  +  2)  = 

(unsigned  char) 


(  (CxffOC  5  ( (unsigned  i 
(OxOOff  &  (unsigned  inn 


)  £  i  ZC  3  * 
iicc5  :sr)  ? 


/*************★**★******★*■***********★*■***********★****-**•»*******  *  *  *  *  *  •  *  «  w  »  » 

/*  Function  assumes  that  the  OC  that  we  used  is  not  0C1 
/*  (OC1  does  not  work  as  the  other  OC  cf  HC11  manual) 

/*  Number  passed  is  the  output  compare  number  less  one 

void  InitOC(int  OCnum,  int  Enable! 


{ 

*OC_Add [OCnum]  =■  0x0000;  /*  set  output  compare  timer  indexes  no  zer:  • 

/*  set  register  so  that  nothing  is  done  to  A' s  Din  upon  next  internet  • 
ClearBit  (TCTLl_Add,  (9  -  (  2  *  OCnum  )));"' 

ClearBit  (TCTLl_Add,  (3  -  (2  *  OCnum  )  )  ); 

ClearFlag (TFLGl_Add, ( 8-  (OCnum  +  1)));  /*  clear  interrupt  flag  for  CCx  * 

ServoStatus [OCnum]  *  B_LOW; 
if (Enable) 
f 

SetBit (TMSKl_Add, ( 8-  (OCnum  t  1)));  /*  enable  interrupt  for  CCx  */ 

I 

) 


/*  Initialize  the  HC11  flags,  baud  rate... to  enable  the  reception  */ 

/*  must  be  called  once  before  using  the  SCI  transmission  features  */ 

void  SCI_init_TX (void) 

( 

SetBit (SCCR2_Add, 3) ;  /*  Enable  transmission  TE-1  */ 

DisableTXbuf fEmptylnt ( ) ;  /*  sable  TX  data  buffer  empty  interrupt  */ 

DisableTXcompletelnt () ;  /*  Disable  TX  complete  interrupt  */ 

( 


/*  Initialize  the  HC11  flags,  baud  rate... to  enable  the  reception  */ 

/*  must  be  called  once  before  using  the  SCI  reception  features 

/*#*******#*******************************************************«****ir*#»*w. 

void  SCI  init  RX(void) 


( 

*LATCH_SCI_Add 

AckWanted 

Overrun 

NoiseFramlag 

UnknownCo— ndl 

UnknownCommand2 

NoStopChar 

IndexError 

RXstream 


0x01;  /*  enable  SCI  on  HC11  board  by  setting  flic  floov 

FALSE? 

FALSE; 

FALSE; 

FALSE; 

FALSE; 

FALSE; 

FALSE; 

FALSE? 


/*  baud-4800  assuming  8  MHz  clock  */ 
SetBit  <BAUD_Add,  4)  ; 

SetBit (BAUD- Add, 5)  ; 
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SetBit ( BAUD_Add, 0) ; 
ClearBit (BAUD_Add, 1) ; 
ClearBit (BAUD_Ada, 2) ; 

ClearBit (SCCRl_Add, 4) ; 
ClearBit  <SCCRl_Add, 3) ; 

SetBit (SCCR2_Add, 2) ; 
ClearBit (SCCR2  Add,4); 


/*  format  of  the  datas  is  3 


/*  Enable  RX  RE=1  */ 

/*  Disable  Idle  Line  Interrt 


ReinitializeReceive ( ) ; 

1  /*  end  function  SCI_init_RX  */ 

/********************************************************»**»***it»»i 


/*  Initialize  the  time  low  for  all  Output  Compares  (set  to  1ms  mi; 
/*  Initialize  the  time  high  for  them  as  well  */ 
/***************■***********************************»,>„,  #,■*«***»»* 

void  InitServos (void) 


int  i; 


for  (i 


NUM  PA; 


ThighPA[i]  *  (unsigned  int)ONE_MS; 

)  /*  Set  Sephamore  to  indicate  that  Port  A  is  low  */ 

for  (i  «  0;  i  <=*  NUM_PB;  i++) 

{ 

ThighPBfi]  -  (unsigned  int)ONE_MS; 

}  /*  set  Sephamore  to  indicate  that  Port  B  is  low  */ 

'*  set  specific  values  for  particular  servo  controls  */ 


ThighPB  [THROTTLE] 
ThighPA  [AILERON] 
ThighPB  [ELEVATOR] 
ThighPA  [RUDDER] 
ThighPB  [TO_GYRO] 
ThighPA  [COLLECTIVE] 


(unsigned  int) THROTTLE_DEFAULT; 
(unsigned  int) AILERON_DEFAULT; 
(unsigned  int) ELEVATOR_DEFAULT; 
(unsigned  int) RUDDER_DEFAULT; 
(unsigned  int) TO_GYRO_DEFAULT; 
(unsigned  int) COLLECTIVE_DEFAULT; 


*TCTLl_Add  “  0x00;  I*  OC2,3,4,5  set  register  OC  disconnected  from  outputs  */ 
*TFLGl_Add  ■  0;  /*  clear  all  pending  IC  and  OC  interrupts  */ 

*PORTA_Add  »  0;  /*  set  all  servo  outputs  to  zero  */ 

*PORTB_Add  -  0; 

*OClM_Add  *  0x00;  /*  disable  OC1  (default)  */ 

]  /*  end  initialize  high  &  low  times  for  servo  control  */ 


/*****************************•»•»****************************************»»*»« 
/*  Initialization  of  the  HC11  registers  to  use  the  ADconverter  ’ / 

void  InitADconverter (void) 


SetBit (OPTION_Add, 7) ;  /*  ADPDU-1  */ 
ClearBit (OPTION_Add, 6) ;  /*  CSEL-0  */ 
SetBit (OPTION  Add, 4) ;  /*  DLY-1  */ 
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/*****************»»******'*r-**irir***-****it********«’»**»*1r». 

/*  This  routine  makes  the  pointer  variables  representing  tr.e  Hill  reg-  start  * 
/*  point  to  the  corresponding  addresst ~ 

/**-****************ir<r***ir********w»-»w»r*********r»*ir«»r***-»»r*ir***r«-«»*«r-^»*»««-» 

void  InitPointer ( void) 

( 

TCNT_Add  =  4H11TCNT;  /*  Main  Timer  count  register 
TMSK2_Add  =  4H11TMSK2;  /*  Interrupt  Mask  for  timer  operations  ’ 

TFLG2_Add  =  4H11TFLG2;  /*  Flag  Register  for  timer  operations  */ 

IC_Add [ IC1_NUM]  =*  &H11TIC1;  /’  Array  of  the  3  Input  Caotore  rec-sters  * 

IC_Add[IC2_NUM]  -  4H11TIC2; 

I C_Add [ I C 3_NUM ]  «  &H11TIC3: 

TMSKl_Add  »  &H11TMSK1 ;  /'  IC  «  OC  mask  register  */ 

TFLGl_Add  *  4H11TFLG1;  /*  IC  4  OC  flag  register  «/ 

TCTL2_Add  -  4H11TCTL2;  /*  ??  */ 

OC_Add[OCl_NUM]  =•  4H11TOC1;  /*  Array  of  the  5  Output  Compare  registers  ’ 

OC_Add [ OC2_NUM ]  -  4H11TOC2; 

OC_Add [ OC 3_NUM ]  -  &H11TOC3; 

0C_Add[0C4_NUM]  -  4HUT0C4; 

OC_Add[OC5_NUM]  -  4H11TOC5; 

TCTLl_Add  -  4H11TCTL1  •  /*  Timer  Control  Register  #1:  for  0C5  -  0C2  */ 

OClD_Add  -  4H110C1D;  /*  Data  for  0C1  */ 

OClM_Add  -  4H110C1M;  /*  Mask  for  OC1  */ 

PACTL_Add  “  4H11PACTL;  /*  Pulse  Accumulator  Control  register  */ 

SCSR_Add  =  &H11SCSR;  /*  SCI  registers  */ 

SCDR_Add  *  4H11SCDR; 

SCCR2_Add  -  4H11SCCR2; 

SCCRl_Add  -  4H11SCCR1; 

BAUD_Add  «  4  H 1 1 BAUD ; 

LATCH_SCI_Add  *  (unsigned  char  *)LATCH_SCI;  Latch  to  enable  the  SCI  AX 

*/ 

I*  This  latch  is  software  controllable  and  must  be  initialized  */ 
P0RTB_Add  «  4H11PORTB;  /*  communication  ports  */ 

PORTA_Add  *  4H11PORTA; 

OPTION_Add  «  4H110PTI0N;  /*  AD  Converter  control  registers  */ 

ADCTL_Add  -  4H11ADCTL; 

ADRl_Add  ■  4H11ADR1;  /*  AD  converter  reg  that  hold  the  converted  values 

*/ 

ADR2_Add  -  4H11ADR2; 

ADR3_Add  -  4H11ADR3; 

ADR4_Add  -  4H11ADR4; 

/*  Calibrated  values  of  the  potentiameters  programmed  in  the  ESPROM  •/ 
Slopelz_Add  -  (double  *) SLOPElz_ADDRESS; 

Slope2z  Add  -  (double  *)SL0PE2z  ADDRESS; 

Slope2x_Add  -  (double  *) SL0PE2x~ADDRESS; 

VlzO_Add  •  (unsigned  char  *) Vlz_ADDRESS; 

V2zO_Add  -  (unsigned  char  * ) v2z~ADDRESS; 

V2xO_Add  -  (unsigned  char  * ) v2x_ADDRESS; 

Slope3pitch_Add  -  (double  *) SL0PE3pitch  ADDRESS; 

Slope3roll_Add  »  (double  * ) SL0PE3roll_ADDRESS; 

Slope3yaw_Add  »  (double  * ) SLQPE3yaw_ADDRESS; 
v3pitchO_Add  -  (unsigned  char  * ) V3pitch_ ADDRESS; 
v3rollQ_Add  -  (unsigned  char  *) V3roll_ADDRESS; 
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V3yawO_Add  =  (unsigned  char  * ) V3yaw_ADDRES3; 

} 
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/  *  Geo  rge  Me s on  'Jr. i ve r  s  i  o v 

/*  Department  of  Electrical  ana  Computer  Er.g_r.ee r . no 

/*  File  Name:  FAMEISR.c 
/  ♦ 

/*  Authors:  Bertina  Ho-Mcck-Qai,  Darrell  Duar.e,  Her.  H_r.cc 
/*  Update  History:  Version  1.1,  Feoruary  23,  13^2 


/  * 


I 


/* - 

/*  ISR  for  OC3,  OC4 ,  0C5 

/*  ISR  triggered  when  value  in  OC3' s  register  =  timer  value 

/  * - 

void  0C3_ISR (void) 

( 

switch  (ServoStatus [0C3_NUMJ ) 

( 

case  B_LOW: 

1 

ServoStatus [GC3_NUM]  =  A_HIGH; 

/*  set  output  compare  to  new  value 

*OC_Ad'  D3_NUM]  =  *TCh’T_Add  +  ThighPA  [COLLECTIVE  j 

-  SOFTWARE_CORRECTION; 

SetBit  ii-ORTA_Add,  PAS)  ;  /*  Set  Port  A  Bit 

ClearFlag  (  TFLGl_Add,  (7  -  OC3_NUM  )  );  /*  clear  int  flag 

SetBit (TMSKl_Add, (7  -  0C3_NUM  )  );  /*  enable  interrupt  for  CCx 

break; 

} 

case  A_HIGH: 

! 

/*  autc  clear  does  not  seem  to  work  correctly 
ClearBit (PORTA_Add, PAS ) ;  /*  CLEAR  Port  A  Bit 

ServoStatus [0C3_NUM]  -  A_LOW; 

•OC_Add [0C3_NUM]  -  *  TCNT_Add  +  INTER_PULSE_DURATION 

-  SOFTWARE_CORRECTION;  ;  / *  delta  pulses  ' 

ClearFlag  (  TFLGl_Add,  (7  -  OC3  NUM  )  );  /*  clear  int  flag  * 

SetBit (TMSKl_Add, (7  -  0C3_NUM  )~);  /*  enable  interrupt  for  CCx 

break; 

) 

case  A_LOW: 

{ 

ServoStatus [OC3_NUM]  -  B_HIGH; 

/*  set  outDut  compare  to  new  value 

*0C_Add[0C3_NUM)  »  *TCNT_Add  +  Thi ohPB [ TO_GYRO)  -  SOFTWARE  CORRECT I CN ; 

SetBit <PORTB_Add,PB2) ;  /*  s~z  Port  B  Bit 

ClearFlag  <  TFLGl_Add,  (7  -  0C3_.,UM  )  );  /*  clear  int  flag 

SetBit (TMSKl_Add, (7  -  OC3_NUM  )  );  /*  enable  interrupt  for  CCx 

break; 

) 

case  8_HIGH: 

{ 

ClearBit (PORTB_Add,  PB2)  ;  /*  set  Clear  Port  B  Bit 

ClearFlag  (  TFLGl_Add,  (7  ^  QC3_NUM  )  ),-  /*  clear  int  flag 
/•disable  OC3  interrupt 

ClearBit (TMSKl_Add, (7  -  0C3_NUM  )  );  /*  disable  interrupt  for  0C3  • 

ServoStatus [OC3_NUM]  -  B_LOW; 

/*  load  0C4  timer  for  short  inferpulse  duration 

* OC_Add [ OC 4 _NUM ]  -  *"CNT_Add  +  INTER_PULSE_DURATION 

: OFTWARE_CORRECT I ON  ; 
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I 


I 


I 


i 


I 


i 


< 


l 


/*  enable  int  far  #4  now  so  it  has  a  chance  without  cemg  inter ructeu 
ServoStatus  [CC4_NL’Mj  =  3_LCW; 

ClearFlag  (  TFLGl_Add,  <7  -  CC4_NUM  !  !;  /*  clear  int  flag 

Set  Bit  (TMSKl_Add,  (7  -  CC4_N'UM  )  );  /*  enable  interrupt  fcr  :C4 

break; 

} 

} 

asm ( "  RTI\n”) ;  /*  asm  command:  Return  from  Interrupt 

i 


/* - 

/*  ISR  triggered  when  value  in  OC4's  register  =  timer  value 

/* - . 

void  OC4_ISR (void)  /*  ISR  triggered  when  CC4's  register  =  timer  va..e 

{ 

switch  (ServoStatus [OC4_NUM] ) 

( 

case  B_LOW: 

l 

ServoStatus [OC4_NUM]  =  A_HIGH; 

/*  set  output  compare  to  new  value 
*OC_Add[OC4_NUM]  -  *TCNT_Add  +  ThighPA [RUDDER] 

-  SOFTWAR£_CORRECTION; 

SetBit (PORTA_Add,  PA4) ;  /*  set  Port  A  Bit 

ClearFlag  (  TFLGl_Add,  (7  -  0C4_NUM  )  );  /*  clear  int  flag 

SetBit (TMSKl_Add, (7  -  OC4_NUM  )  );  /*  enable  interrupt  for  CCx  */ 

break; 

} 

case  A_HIGH: 

{ 

/*  auto  clear  does  not  seem  to  work  correctly 
ClearBit (PORTA_Add, PA4 ) ;  /*  set  Port  A  Bit 

ServoStatus C0C4  NUM]  -  A_LQW; 

* OC_Add t OC 4_NUM ]  -  *TCNT  Add  +  INTER  PULSE_DURATION 

-  SOFTWARE_CORRECTION;  /*  between  pulses 

ClearFlag  (  TFLGl_Add,  (7  -  0C4_NUM  )  );  /*  clear  int  flag 
SetBit (TMSKl_Add, (7  -  OC4_NUM  )  );  /*  enable  interrupt  fcr  CCx 

break; 

) 

case  A_LOW : 

{ 

ServoStatus [0C4_NUM]  »  B_HIGH; 

/*  set  output  compare  to  new  value  */ 

*OC_Add[OC4  NUM]  -  *TCNT  Add  +  ThighPB [ELEVATOR] 

-  SOFTWARE_CORRECTION; 

SetBit (PORTB_Add, PB1) ;  /*  set  Port  A  Bit  */ 

ClearFlag  (  TFLGl_Add,  (7  -  0C4_NUM  )  );  /*  clear  int  flag  »/ 

SetBit (TMSKl_Add, (7  -  0C4_NUM  )  );  /*  enable  interrupt  for  CCx  '/ 

break; 

l 

case  B_HIGH: 

( 

ClearBit (PORTB_Add, PB1) ;  /*  set  Clear  Port  B  Bit 

ClearFlag  <  TFLGl_Add,  (7  -  OC4_NUM  )  );  /»  clear  int  flag 
/‘disable  OC4  interrupt  *  '' 

ClearBit (TMSKl_Add, (7  -  OC4_NUM  )  );  /*  disable  interrupt  for  GC4  */ 

ServoStatus [0C4_NUM]  »  B_LOW; 

/*  load  0C5  timer  for  short  interpulse  duration  * / 

*0C  Add[0C5  NUM)  -  *  TCNT_Add  +  INTER_PULSE_DURATION 
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-  softwarejcorrecticn; 

/*  enable  int  for  #5 

ServoStatus (0C5_NUM]  *  B_LOW; 

ClearFlag  (  TFLG1  Add,  (7  -  OCS_NUM  )  );  /*  clear  int  flag 

SetBit (TMSKl_Add,77  -  0C5_NUM  )  );  /*  enable  interrupt  for  ZCx 

break; 

} 

l 

asm("  RTI\n") ;  /*  asm  command:  Return  from  Interrupt 

) 


/  * - 

/*  ISR  triggered  when  value  in  CCS' s  register  »  timer  value 

/* - 

void  OC5_ISR (void)  /*  ISR  triggered  when  OC5's  register  =  timer 


switch  (ServoStatus [OC5_NUM] ) 

f 

case  B_LOW: 

{ 

ServoStatus [OC5_NUM]  -  A_HIGH; 

/*  set  output  compare  to  new  value 
* OC_Add [ OC 5_NUM ]  *  *TCNT_Add  +  ThighPA [AILERON] 

-  SOFTWARE_CORRECTION; 

SetBit <PORTA_Add,PA3) ;  /*  set  Port  A  Bit 

ClearFlag  (  TFLGl_Add,  (7  -  OC5_NUM  )  ) ;  /*  clear  int  flag 

SetBit (TMSKl_Add, (7  -  0C5_NUM  )  );  /*  enable  interrupt  for  OCx 

break; 

} 

case  A_HIGH: 

{ 

ClearBit (PORTA_Add, PA3) ;  t*  set  Port  A  Bit 

ServoStatus [OC5_NUM]  -  A_LOW; 

*OC_Add[OC5_NUM]  -  *TCNT_Add  +  INTER  PULSE_DURATION 

-  SOFTWARE_CORRECTION;  /*  INTER  PULSE 

ClearFlag  (  TFLGl_Add,  (7  -  OC5_NUM  )  );  /*  clear  int  flag 
SetBit (TMSKl_Add, (7  -  OC5_NUM  )  >;  /*  enable  interrupt  for  CCx 

break; 

) 

case  A_LOW: 

( 

ServoStatus [OC5_NUM]  -  B_HIGH; 

/*  set  output  compare  to  new  value 

* OC_Add [ OC 5_NUM ]  -  *TCNT  Add  +  ThighPB [THROTTLE]  -  SOFTWARE_CORRECTICN 

SetBit (PORTB_Add, PBO) ;  “  /*  set  Port  A  Bit 

ClearFlag  (  TFLGl_Add,  (7  -  0C5_NUM  )  );  /*  clear  int  flag 

SetBit (TMSKl_Add,77  -  0C5_NUM  )“);  /*  enable  interrupt  for  OCx 

break; 

} 

case  B_HIGB: 

{ 

ClearBit (PORTB_Add, PBO) ;  /*  set  Clear  Port  B  Bit 

ClearFlag  (  TFLGl_Add,  (7  -  0C5_NUM  )  );  /*  clear  int  flag 
/•disable  0C5  interrupt 

ClearBit (TMSKl_Add, (7  -  OC5_NUM  )  );  /*  disable  interrupt  for  CC5 

/*  *OC  Add[OC5  NUM]  -  *TCNT  Add;*/  /*  set  output  compare  to  new  value 
*/ 

ServoStatus [OC5_NUM]  -  B_LOW; 

/*  load  0C3  timer  so  that  only  one  roll  over  is  used  before  next  pulses 
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*0C_Add(0C3_NUMj  =  *TCNT_Add;  /*  set  output  compare  t:  r.ew  vsl.e 

/*  enable  int  for  13 

ServoStatus [OC3_NUM]  =  3_LCW; 

ClearFlag  (  TFLGl_Add,  (7  -  0C3  NUM  )  );  /*  clear  ir.t  flaa 

SetBit (TMSKl_Add,  (7  -  OC3_N'UM  )  );  '  *  enable  interrupt  for  1C;< 

break; 

1 

( 

asm("  RTI\n")  ;  /*  asm  command:  Return  from  Ir.terruot 

} 

/* - - 

/*  ISR  for  data  received  or  transmitted  via  the  SCI.  As  there  is  only  or. 
/*  physical  interrupt  for  the  SCI,  function  checks  to  see  which  activity 
/*  is  occuring  according  to  the  flags  and  calls  the  corresponding  fur.cti 

/* - ' - 

void  SCI_ISR (void) 

( 

if(  (*SCSR_Add  &  0x2E)  !=  0x00)  /*  was  this  ISR  triggered  by  a  char  ?.Xe 

SCI_RX_ISR()  ; 
else 

if (  ( ( *SCSR_Add  4  0x80)  !=  0x00)  ) 

/*  was  this  ISR  triggered  by  TDRE=1  (the  TX  data  register  empty) 
SCI_TX_ISR ( ) ;  /*  transmit  acknowledgement  values  to  PC 
else 
{ 

printf(’*SCI  ISR  triggered  for  reasons  unknown.  5CSR*  0 x * x  SCCAI=  ixix 
*SCSR_Add,  *SCCR2_Add); 

DisabletXbuf fEmptylnt ( ) ; 

) 

asm("  RTI\n" ) ;  /*  asm  command  Return  From  Interrupt 

)  /*  end  SCI_ISR  */ 

/* - 

/*  Main  ISR  to  transmit  characters  to  the  work  station. 

/*  Transmits  second  through  last  characters  of  string. 

/*  Sending  of  first  character  done  by  TXfirst 

/* - 

void  SCI_TX_ISR (void) 

{ 

TXindex++; 

switch (ValidCommandChar) 

( 

case  POS  REQ  COM_CHAR: 

*SCSR_Add  ~  =  *SCSR_Add; 

*SCDR_Add  »  Po3AckBuf f [TXindex]  ; 
if (TXindex  >-  (POS_ACK_STRING_LENGTH 
{ 

DisableTXbuf fEmptylnt () ; 

) 

break; 

case  SER  REQ_COM  CHAR: 

*SCSR_A3d  -  *SCSR_Add; 

*SCDR_Add  -  SerAckBuff [TXindex) ; 

if (TXindex  >-  (SER_ACK_STRING_LENGTH 
{ 

DisabieTXbuf fEmptylnt  0 ; 
l 

break; 
default : 


/*  Flag  TORE  is  cleared 
/*  normal  transmission 
-  1) )  /*  last  char  of  sequence 


/*  Flag  TDRE  is  cleared 
/*  normal  transmission 
-  1))/*  last  char  of  sequence  ? 
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printf ( "Unknown  type  of  request  for  TX  in  SCI  TX  ISRO'r" 
break; 

)  /*  end  switch () 

}  /*  end  ISR  to  TX 


/  * - 

/*  ISR  for  RX 

/* - - - 

void  SCI_RX_ISR (void) 

{ 

SaveRegO;  /*  Read  SCDR  &  SCSR  -->  clear  RDRF  bit 
#ifdef  TESTO 

putchar ( (int ) WorkRXdata)  ; 

#endif 

RXerrorO;  /*  Check  for  Reception  Errors 
if(  (  Overrun  «»  FALSE) 

&&  (  NoiseFraming  »  FALSE))  /*  we  are  NOT  presently  rxing  a  string? 
if (  (WorkRXdata  --  START_CHAR) 

&4 (RXstream  **  FALSE))  /*  and  the  first  character  is  the  start  char 

{ 

RXstream  =  TRUE;  /*set  the  rxing  stream  semaphore 

RX index  -  START_CHAR_IND£X; 

^  /*  start  char  is  NOT  put  into  string  buffer 

else  if  (RXstream  =*«  TRUE) 

{ 

CharRXO;  /*  in  string,  after  start  char,  store  character 

) 

) 

else 

RXstream  *  FALSE; 
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/«*«*■***««»«*»*»*******«*««**»**«»«»»*» 

/*  George  Mason  University 

/*  Department  of  Electrical  and  Computer  Engineering 

/* 

/*  rile  Name:  FAMELIB . C 
/* 

/*  Authors:  Bertina  Ho-Mock-Qai ,  Darrell  Duane,  Ken  Kir.tz 
/*  Update  History:  Version  1.0,  February  23,  1992 

/•A'****-************-********-******************'*'*****'***'**  *  w  *  «r  *  »  *  *•  *  w  w 

/*  Function  called  after  a  complete  servo  command  sequence  is  rece 
/*  transmits  'SAs' 

f  a********1******************'*******'*********#********  *  *  »  *  *  *  *  «  *  *  *  »  * 

void  FillSerAckBuf f ( void) 

{ 

SerAckBuf f[START_CHAR_INDEX]  «  START_CHAR; 

SerAckBuf f [COM_CHAR_INDEX]  =  SER_ACK_CCM_CHAR ; 

SerAckBuf f [SER_ACK_STRING_LENGTH  -  1]  =  STOP_CHAR; 

1 


/*  Checks  for  overrun,  framing,  noise  error 

fxXitX***ieXXXXXX*XX*XX**x***XX*XXX*X***X*****X*XX*X***Xxx**9n99*999 

void  RXerror (void) 

{ 

Overrun  =  FALSE; 

NoiseFraming  «  FALSE; 

if (  (GetBit_Char (WorkSCSR, 1) !=0) 

I  I  (GetBit_Char (WorkSCSR,  2)  !-0)) 

{ 

NoiseFraming  »  TRUE; 

) 

if (GetBit_Char (WorkSCSR, 3)  ! =  0) 

( 

Overrun=TRUE; 

) 

)  /*  end  of  function  RXerror ()  */ 


/************************************»**»***»»*************»*****» 
/*  Save  the  SCI  receive  buffer  and  the  flag  register  of  the  SCI 

/*  It  is  the  first  operation  performed  when  a  RX  interrupt  occurs 
/****************************************■****************»**«*«>,** 

void  SaveReg (void)  /*  This  function  clears  the  RDRF  flag  of  the  3 
( 

WorkRXdata  -  *SCDR_Add; 

WorkSCSR  -  *SCSR_Add; 

WorkRXdata  ■  ‘SCDR^Add;  /*  to  clear  interrupt 

asm("int2  CLI\n“);  /*  enable  interrupt  to  allow  OCs  to  operate 

} 
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/***»****«X**w**********jr***«:***«r»*Xwie*ir>r****«*«****»irir*«*  <t  *  *  *  «  *  m  r  »  »  •  •  •  ,  .  . 

/*  Concatenates  2  characters  RXed  into  an  integer  vai.e 

/*******»**«***************«•»«**»»»«»««»*»*<>«*«»«»»«. 

int  Concat_Int (unsigned  char  MSbits, unsigned  char  LSbits; 

! 

MSBits  -  MSbits; 

LSBits  =  LSbits; 

concat_int () ;  /*  assembly  language  routine  in  file  concac.sll 

return  Concat_2B; 

) 


/****************X*X********************»*******»*********»»ir***»**#*r**»** 

/*  This  routine  clears  to  0  a  given  bit  of  a  giver,  byte. 

/*  This  byte  is  pointed  to  by  pointer 

/*★***★★★★**★*★*★★★***★**★*★**★★★★***★★**»★★★*■**★★★***»■»**•**  *  *  it  *  *  *  m  w  *  *  *  »  »  * 

void  ClearBit (unsigned  char  ‘pointer, int  NumBit) 


! 

switch (NumBit ) 
{ 


case 

0;  ‘pointer 
break; 

3 * 

‘pointer 

& 

MASKQ 

case 

1:  ‘pointer 
break; 

s 

‘pointer 

& 

MASK1 

case 

2;  ‘pointer 
break; 

m 

‘pointer 

& 

MASK2 

case 

3;  ‘pointer 
break; 

m 

‘pointer 

& 

MASK3 

case 

4:  ‘pointer 
break; 

* 

‘pointer 

& 

MASK4 

case 

5:  ‘pointer 
break; 

a 

‘pointer 

& 

MASK5 

case 

6:  ‘pointer 
break; 

* 

‘pointer 

& 

MASK6 

case 

7 :  ‘pointer 

* 

‘pointer 

& 

MASK7 

break; 

} 


> 


/**************************************★*★******************★**★********** 
/*  This  routine  clears  to  0  a  bit  of  a  given  flag  register  (TFLG1  or  * 

/*  TFLG2 ) .  To  do  so,  a  1  must  be  written  to  the  bit  to  be  cleared. 

/*  (see  HC11  manual)  It  was  verified  that  the  assembly  language  * 

/*  translation  of  this  function  uses  the  BCLR  instruction  as  prescribed  * 
/*  in  section  10.2.4  of  the  reference  manual 

/******************************************»**#**************«****X******* 

void  ClearFlag (unsigned  char  ‘pointer, int  NumBit) 

{ 

switch (NuaBit) 

{ 

case  0:  ‘pointer  »  CMASKO; 
break; 

case  1:  ‘pointer  *  CMASK1; 
break; 

case  2:  ‘pointer  -  CMASK2 ; 
break; 

case  3:  ‘pointer  -  CMASK3; 
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} 


break; 

case  4:  ‘pointer 
break; 

case  5:  ‘pointer 
break; 

case  6:  ‘pointer 
break; 

case  7:  ‘pointer 
break; 

} 


CMASK4; 

CMASK5; 

CMASK6; 

CMASK7; 


/********■«****•***■****************★*************»*****»**»***«*•»*•»»**■*  »  »«  » 
/*  This  routine  sets  to  1  a  given  bit  of  a  given  byte. 

/*  This  byte  is  pointed  to  by  a  pointer. 

/*********************„***********************»**************, «■**,«*»»,,,,.■ 

void  SetBit (unsigned  char  ‘pointer, int  NumBit) 

{ 

switch (NumBit) 

{ 


case 

0:  ‘pointer 
break; 

* 

‘pointer 

1 

CMASKO; 

case 

1:  ‘pointer 
break; 

= 

‘pointer 

1 

CMASK1; 

case 

2:  ‘pointer 
break; 

‘pointer 

1 

CMASK2; 

case 

3:  ‘pointer 
break; 

SB 

‘pointer 

1 

CMASK3; 

case 

4:  ‘pointer 
break; 

~ 

‘pointer 

I 

CMASK4 ; 

case 

5:  ‘pointer 
break; 

=r 

‘pointer 

1 

CMASKS; 

case 

6:  ‘pointer 
break; 

a 

‘pointer 

1 

CMASK6; 

case 

7:  ‘pointer 
break; 

* 

‘pointer 

i 

CMASK7 ; 

default:  printf ("Invalid  Request  to  change  bit  -  %d", NumBit); 
) 

1 


/a***************************************************************#********/ 
/*  This  routine  alLows  to  test  the  value  of  a  given  bit  of  a  byte.  '/ 
t  *  This  byte  ia  pointed  to  by  pointer.  */ 
/*****************************************»************************»**»**»/ 
unsigned  char  GetBit (unsigned  char  ‘pointer, int  NumBit) 


( 

unsigned  char  BitResult; 

switch (NumBit) 

( 

case  0:  BitResult- (‘pointer  &  CMASKO) 
break; 

case  1:  BitResult- ( ‘pointer  &  CMASK1) 
break; 

case  2:  BitResult- (‘pointer  &  CMASK2) 
break; 

case  3:  BitResult- (‘pointer  S  CMASK3) 
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break; 

case  4;  BitResult- ( ‘pointer  &  CMASK4 ) ; 
break; 

case  5:  BitResult- (‘pointer  &  CMASKS) ; 

break; 

case  6;  BitResult- ( ‘pointer  4  CMASK6 )  ; 
break; 

case  7:  BitResult- ( ‘pointer  &  CMASK7 ) ; 
break; 

) 

return (BitResult) ; 

} 


/*-k***it****ir*******************-k***1t-kir*irirfXi'K***iriiiiiritirirw****w***Kvw  +  -*w 

/*  This  routine  allows  to  test  the  value  of  a  given  bit.  of  a  cyoe 

/*»*********ilr*******************************»«w*******,«*«.«w«,.» 

unsigned  char  GetBit_Char (unsigned  char  reg, int  NumBit} 

{ 

unsigned  char  BitResult; 

switch {NumBit) 

{ 

case  0:  BitResult- (reg  &  CMASKO); 
break; 

case  1:  BitResult- (reg  &  CMASK1); 
break; 

case  2:  BitResult- (reg  4  CMASK2); 
break; 

case  3:  BitResult- (reg  &  CMASK3) ; 
break; 

case  4:  BitResult- (reg  &  CMASK4) ; 
break; 

case  5:  BitResult- (reg  &  CMASK5) ; 
break; 

case  6:  BitResult- (reg  &  CMASK6) ; 
break; 

case  7:  BitResult- (reg  &  CMASK7); 
break; 

) 

return (BitResult) ; 

) 


/*★*******★***★★******★★*★****★***★************★*******************«»* 
/*  Cuts  an  integer  into  2  bytes  &  returns  the  values  in  MSbits  and  LS3 
/********************************■******************«***********>!****** 

void  Split_Int (int  Data_To_Split) 

( 

Int  To  Split  »  Data_To_Split; 

splTt_Tnt();  " 

) 
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/*  This  function  calculates  the  checksum  of  seouer.ces 

/'*  ignores  Oth,  last,  and  (last  -  1)  elements  of  array 
i *  i.e.,  it  ignores  the  start,  checksum,  and  stop  characters 

unsigned  char  Checksumfint  stringlength,  unsigned  char  CheckArray [ 

{ 

unsigned  char  ChecksumResult  ■  0; 
unsigned  int  sum  *  0; 

int  i; 

for(i  -  1;  i  <  stringlength  -  2;  i++) 
sum  =  sum  +  CheckArray [ i ]  ; 

ChecksumResult  **  (unsigned  char) sum; 
return  ChecksumResult; 

}  /*  end  checksum  function  */ 
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6.2.  Appendix  II:  MC68HC11  Assembly  Source  Code 


—  —  —  —  —  —  —  —  —  —  — _ _ _ _ _  _  _ _ 

*  Function  to  split  an  integer  into  2  bytes  MSBrts  lS=rts 

^  —  —  —  —  —  —  —  —  —  —  —  —  —  —  —  —  —  —  —  —  —  —  —  —  —  — 


import  MSBits 
import  LSBits 
import  Int_To_Split 

section  .text 


*  Most  significant  byte  result 

*  Least  significant  byte  result 

*  Integer  to  split 


split_int : 

ldaa  Int_To_Split 

staa  MSBits 

ldaa  Int_To_Split+l 

staa  LSBits 

rts 

end 


*  Function  that  concats  2  bytes  into  a  16  bit  integer 

_ _  _ — _ — _ 


import  MSBits  *  Most  significant  bits  of  the  integer 

import  LSBits  *  Least  significant  bits  of  the  integer 

import  Concat_2B  *  result  of  the  concatenation 

section  .text 

concat_int : 

ldaa  MSBits 
staa  Concat_2B 
ldaa  LSBits 
staa  Concat_2B+l 
rt3 
end 
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6.3.  Appendix  III:  Linker  Command  File 


/  * - - - - 

/*  File:  fame32-3.id 
/*  vers=l.Q 

/  * 

/*  Configuration  is  a  Motorola  MC68HC11EV3  evaluation  otari. 

/*  This  is  designed  for  programs  that  are  used  WITH  the 
/*  BUFFALO  monitor.  The  executable  code  and  initialized  data  will 
/*  placed  in  an  8Kx8  RAM  at  OxCOOO. 

/* 

/*  Modification  historv: 

/*  KJH:  for  32 kbyte' SRAM  1/29/92 

/* - - 

set  HllRAM  =  0x00;  /*  page  containing  68HC11  case  cage  ' 

set  HI IRE G  =  0x01;  /*  page  containing  68HC11  registers  ' 

set  H11VECSIZE  -  42;  /*  size  of  68HC11  vectors 

set  H11RAMREG  =  (HI  1RAM«4 )  |  H11REG;  /  *mask  for  setting  HllINIT  in  start,  s  ■ 

set  H11REGORG  =  (H11REG<<12)  /*  origin  of  68KC11  registers 

set  HI 1VECORG  =  OxlOOOO-HllVECSIZE;  /*  origin  of  68HC11  vectors  */ 

section  .base  bss  origin  0  maxsize  =  0x34  =  .base;  /*  uninitialized  base  pa 
storage  */ 

section  .textl  origin  0x1800  maxsize  (0x4000  -  0x1800)  =  .text; 
section  .text2  origin  0x6000  maxsize  -  8192  *  .text; 


section  .bss  bss  origin  endof  (.text2)  bss  comms;/*  followed  by  uni 


storage*/ 

section  .data  origin  endof  (.bss); 
section  .const  origin  endof (. data) ; 
section  .strings  origin  endof ( .const) ; 
section  . init  origin  endof (. strings) ; 
section  .heap  bss  origin  endof  (.init);  / 

section  .stack  bss  origin  OxdOOO  minsize  (512) 


/*  followed  by  data 


followed  by  constants 
followed  by  strings 
/*  data  to  be  copied  to  RAM 
followed  by  heap 


/*- - - - - 

/*  The  following  line  can  be  used  to  copy  data  from  ROM  into  RAM 
/*  substitute  in  place  of  the  section  .data  line  above  where  the 
/*  underscore  is  replaced  with  the  address  of  the  ROM  where  the  data 
/*  is  to  be  stored 
/* 

/*  section  .data  origin  _  copiedfrom  .init  *  .data; 

/* - 


/  * - ’  / 

/*  Sections  particular  to  the  registers  and  vectors  in  the  EVB .  */ 
/*  Used  by  the  assembler  to  locate  the  registers  and  interrupt  vectors  *' 
/*  at  their  proper  location  in  memory  since  I/O  is  memory  mapped.  */ 
/* - */ 


section  .H11REGS  bss  origin  H11REGORG; 

section  .H11VEC  data  origin  H11VEC0RG  maxsize  H11VECSIZE; 

/* - 

/*  Checks  for  sections  which  exceed  the  limits  of  RAM  on  the  EVB 
/*  If  the  optional  RAM  is  installed,  then  modify  the  limits  accordingly 
/* - 
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check  er.dof  ( .  heap)  >»  0x7fff  fatal  "C:ie  area  tco  large"; 
check  sizeof ( .base)  >  0x34  fatal  "Base  page  ccc  large"; 

/* - 

/*  initializes  some  values  which  are  used  by  the  initialization  ccce  :: 

/*  initialize  various  areas  of  RAM 

/* - * 

set  _ramstart  =  startof { . bss) ; 
set  _ramend  =  endof (.bss); 
set  _heapstart  =*  startof  (.  heap)  ; 
set  _heapend  =  endof (. heap)  ; 
set  _stackstart  *  startof (. stack) ; 
set  _stackend  =  endof (. stack! ; 
set  _initstart  *  startof (. init )  ; 
set  _initend  *  endof (. init ) ; 
set  _datastart  *  startof (. data)  ; 
set  _dataend  =  endof {. data) ; 

check  _stackend  -  _stackstart  <  256  fatal  "Stack  too  small"; 

/* - 

/*  These  object  files  replace  functions  in  the  library  that  are  unique 
/*  to  the  Buffalo  monitor  version 
/  * 

/*  kjhstart.o,  kjhiob.o  and  kjhbuff.o  are  recompiled  versions  cf  *•/ 

/*  (k jh) start . s,  (kjh)iob.s,  and  (k jh) buf f alo . s  which  allows  using  the 
/*  Buffalo  monitor  routines  for  I/O  */ 

/*  *  l 

/*  printf.o  has  been  compiled  to  use  the  BUFFALO  I/O  Calls  and  should  */ 
/*  not  be  included  unless  necessary  since  it  takes  up  quite  a  bit  of  * / 
/ *  space .  * / 

/*  *  / 

/*  ofmt.o  has  been  compiled  with  the  #define  FLOATS  and  LONGS  omitted 
/*  to  reduced  size  of  code. 

/* . - - - - - - - . . . . •/ 


'c:\introl\kjh\kjhstart.o'  /*  start  up  routine  */ 

'c:\introl\kjh\kjhiob.o'  /*  buffalo  input  output  calls 

' c: \introl\k jh\k jhbuf f . o' 

'c:\introl\dd8\concat.o'  /*  puts  two  bytes  RXed  together  to  form  an  Int  ’ / 
'c:\introl\dd8\split.o'  /*  splits  an  Int  into  two  bytes  for  TX  to  FC  */ 

readline;  /*  read  the  command  line  */ 

/* - * 

/*  inclusion  of  the  standard  libraries  to  resolve  external  references 
/* . - . — . . . - - - ' 

-lc  /*  use  the  C  library  */ 

-lcio  /*  C  i/o  library  */ 

-1m  /*  math  library  */ 

-lgen  /*  general  library  ' / 
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/  * - - 

/*  File:  fcal32-3.1d 
/*  vers“1.0 

f  *  , 

/*  Configuration  is  a  Motorola  MC63HC11EV3  evaluation  ctard. 

/*  This  is  designed  for  programs  that  are  used  WITH  one 

/*  BUFFALO  monitor.  The  executable  code  and  initialized  data  «:11 

/*  placed  in  an  8Kx8  RAM  at  OxCOOO. 

/  *  r 

/*  Modification  history: 

/*  KJH:  for  32kbyte  SRAM  1/29/92 

/*  DD:  put  jump  commands  for  ISRs  dir  in  locations  at  SOCCQ  2/6/92  *  / 

/* - «/ 

set  H11RAM  =  0x00;  /*  page  containing  68HC11  base  page  * 

set  H11REG  **  0x01;  /*  page  containing  68HC11  registers  * 

set  H11VECSIZE  =  42;  /*  size  of  68HC11  vectors 

set  H11RAMREG  =  (HI 1RAM<<4 ) | HI 1 REG; / *mask  for  setting  H11INIT  in  start. s  *  / 
set  H11REGORG  =  (H11REG<<12)  /*  origin  of  68HC11  registers 

set  H11VECORG  =*  OxlOOOO-HllVECSIZE;  /*  origin  of  63HC11  vectors 

set  CAL_START  =*  0x7f00;  /*  start  of  calibration  values  ’/ 

section  .base  bss  origin  0  maxsize  *  0x34  =  .base;  /*  uninitialized  base  page 
storage  */ 

section  . ivt  origin  0x00c4  »  .ivt;  /*  Begin  Interrupt  Vector  Table  (SCI  is 
first)  at  Qx00c4  */ 

section  .textl  origin  OxcOOO  maxsize  8192  =  .text; 

section  . text2  origin  0x1800  maxsize  (CAL_START  -  0x1800)  =  .text; 

section  .bss  bss  origin  endof  (.text2)  bss  comms;/*  followed  by  uninit 
storage*/ 

section  .data  origin  endof  (.bss);  /*  followed  by  data 

section  .const  origin  endof (. data) ;  /*  followed  by  constants 

section  .strings  origin  endof (. const) ;  /*  followed  by  strings 

section  . init  origin  endof (. strings) ;  /*  data  to  be  copied  to  RAM 


section  .heap  bss  origin  endof  (.init);  /*  followed  by  heap  */ 

section  .stack  b33  origin  (CAL_START  -  512)  minsize  512; 

/* - / 

/*  The  following  line  can  be  used  to  copy  data  from  ROM  into  RAM  */ 

/*  substitute  in  place  of  the  section  .data  line  above  where  the  */ 

/*  underscore  is  replaced  with  the  address  of  the  ROM  where  the  data  */ 

/*  i3  to  be  stored  •! 

/*  *  / 

/*  section  .data  origin  _  copiedfrom  .init  «  .data;  */ 

/  * - - - *  / 

/  * - *  / 

/*  Sections  particular  to  the  registers  and  vectors  in  the  EVB.  */ 

/*  U3ed  by  the  assembler  to  locate  the  registers  and  interrupt  vectors  */ 
/*  at  their  proper  location  in  memory  since  I/O  is  memory  mapped.  */ 

/* - ,/ 


section  . H11REGS  bss  origin  H11REGORG; 

section  .H11VEC  data  origin  HllVECORC-  maxsize  H11VECSIZE; 

/* - 

/*  Checks  for  sections  which  exceed  the  limits  of  RAM  on  the  EVB 
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/*  If  che  optional  RAM  is  installed,  then  modify  the  limes  a:;:::.::..- 
/  * - — 

check  endof (.stack)  >  CAL_START  fatal  "Cede  area  tec  large"; 
check  endof  (.base)  >  0x34  fatal  "3ase  cage  tea  large'1. 

/  * - —  —  - -  — - -  - —  - - - - - - - > - -  -  -  * 

/*  Initializes  some  values  which  are  used  by  the  initial. zat.  :r.  cede  t  ; 

/*  initialize  various  areas  of  RAM 

/* - - - 

set  _ramstart  =  startof  (. bss ) ; 
set  _ramend  -  endof (, bss); 
set  _heapstart  =  startof (. heap) ; 
set  _heapend  =  endof (. heap) ; 
set  _stackstart  -  startof  {.  stack)  ; 
set  _stackend  *»  endof (. stack) ; 
set  _initstart  »  startof (. init) ; 
set  __initend  *  endof  (.  init)  ; 
set  _datastart  =  startof (. data) ; 
set  _dataend  -  endof (. data )  ; 

check  _stackend  -  _stackstart  <  256  fatal  "Stack  too  small"; 

/* - - 

/*  These  object  files  replace  functions  in  the  library  that  are  unique  * 
/*  to  the  Buffalo  monitor  version  *  ■ 

/* 

/*  kjhstart.o,  kjhiob.o  and  kjhbuff.o  are  recompiled  versions  of  * / 

/*  (k jh) start . s,  (kjh)iob.s,  and  (kjh) buffalo. 3  which  allows  using  the  */ 
/*  Buffalo  monitor  routines  for  I/O  *  / 

/* 

/*  printf.o  has  been  compiled  to  use  the  BUFFALO  I/O  Calls  and  should 
/*  not  be  included  unless  necessary  since  it  takes  up  quite  a  bit  cf 
/*  space. 

/* 

/*  ofmt.o  has  been  compiled  with  the  #define  FLOATS  and  LONGS  omitted 
/*  to  reduced  size  of  code. 

/* - - - - - 


'c:\introl\kjh\kjhstart.o'  /*  start  up  routine 

'c:\introl\kjh\kjhiob.o'  /*  buffalo  input  output  calls 

' c : \introl\k jh\k jhbuf f . o' 

'c:\introl\dd8\splitdb.o'  /*  splits  an  Int  into  four  bytes  for  savin: 

EEPROM  */ 


readline; 


/*  read  the  command  line 


/* - 

/*  inclusion  of  the  standard  libraries  to  resolve  external  references 


-lc 

/* 

use  the  C  library 

-lcio 

/* 

C  i/o  library 

-1m 

/* 

math  library 

-lgen 

/* 

general  library 
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6.4.  Appendix  IV:  PC  (Workstation)  Software 


/*  George  Mason  University 

/*  Department  of  Electrical  and  Computer  Engineer. r.g 

/  * 

/*  File  Name:  FAMEpc.C 

/* 

/*  Authors:  Bertina  Ho-Mock-Qai,  Darrell  Duane,  Ken  Hints 
/*  Update  History:  Version  1.0,  February  23,  1392 
/* 

/* 

/***************#**-#****«-ir**»-*w**************-*«***itir***«*w«w*  w  ««  *  *«  w 

♦include  <stdio.h> 

♦include  <dos.h> 

♦include  <conio.h> 

♦include  <float.h> 

♦include  "famedef.h" 

♦include  "pcdef.h" 

static  void  (interrupt  far  'oldserialint ) (void) ; 
static  void  interrupt  far  newserialint (void) ; 

void  main ( ) 

{  unsigned  char  MenuChoice  (3] ; 

int  Continuelt, i, j, delay;  /*  used  to  allow  for  continuous  operatic 
SERIALPORT=l ;  /*  set  port  to  com  1  */ 

disable ();  /*  General  interrupt  mask  */ 

DisablePC_TXint < ) ;  /*  Local  TX  mask  */ 

clrscr  ()  ; 

InitSerialPort ( ) ;  /*  Initialize  the  UART:  baud,  port...*/ 

InitTXparm ( ) ;  /*  Initialize  the  TX  parameters  */ 

InitRXparm ( ) ;  /*  Initialize  the  RX  parameters  */ 

DisablePC_RXint  0 ; 

enableO;  /*  General  interrupt  mask  */ 

ContinueIt=TRUE; 

NewData=FALSE; 

delaytime*5;  /*  set  delay  between  TX  equal  to  5  miilisecc 

while (Continuelt) 

( 

printf("\n  Fast  Adaptive  Maneuvering  Experiment  --  PC 

Interf ace\n\n") ; 

printfC  Do  you  want  to  send  (P)o3ition  request,  (R)epetitive  pose 
request,  \n") ; 

printfC  (S)ervo  control  values,  (D)efault  servo  control  values, 
printfC  r  (E)  petitively  send  variety  of  servo  control  values,  \n") 
printfC  (I) nteractively  send  position  requests  &  a  variety  of  ser 
values,  \n"); 

printfC  (V)ary  servo  settings  repetitively  with  keyboard,  set  it) 
in\n")  ; 

printfC  milliseconds  to  delay  between  transmissions,  (C)hange  Co 
<Q) uit?\n") ; 

scanf  C%ls",  MenuChoice)  ; 
switch (toupper (MenuChoice [0] ) ) 

< 

case  ' P'  : 

PosOrSer**'  P'  ; 

ClearRXbuf fer ( )  ; 
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TXfirst  ()  ;  / «  Transmit  first  char  of  the  PosReqBuff  * 

AwaitAck ( )  ; 

DisplayData  ( ) ; 
break; 

case  ' R' ; 

PosOrSer*' P' ; 
clrscr ( ) ; 

printf("\n  Repetitveiy  send  position  reauest  to  HC11.  ?re 
exit."); 

WaitForEnter ( )  ; 
while { ! kbhit 0  ) 

( 

ClearRXbuf fer {)  ; 

TXfirst 0;  /*  Transmit  first  char  of  the  PosReqBuff  * 

AwaitAck  ( ) ;  / *  * / 

clrscrO;  /*  clear  screen  */ 

DisplayData ( ) ; 

I 

break; 

case  ' S' : 

PosOrSer=' S ' ; 

EnterServoControlValues  < )  ; 

FillSerReqBuf f ( )  ; 

ClearRXbuf fer ( )  ; 

TXfirst ();  /*  Transmit  first  char  of  SerReqBuff  */ 

AwaitAck ( )  ; 
break; 

case  ' D'  ; 

PosOrSer*' S' ;  /*  servo  control  values  desired  */ 
DefaultServoControlValues ( )  ; 

FillSerReqBuf f ()  ; 

ClearRXbuf fer ( )  ; 

TXfirst ()  ; 

AwaitAck ()  ; 
break; 

case  ' E' : 

j-0; 

PosOrSer-' S'  ; 
clrscr { ) ; 

printf("\n  Repetitveiy  send  varying  servo  control  request  to  HC 
printf("\n  Press  any  key  to  exit."); 

WaitForEnter ( ) ; 
while ( ! kbhit ()  ) 

{ 

VariabieServoControlValues ( j)  ; 
clrscr  < ) ; 

Fi 11 SerReqBuff ()  ; 

ClearRXbuf fer ( )  ; 

TXfirst <);  /*  Transmit  first  char  of  the  PosReqBuff  */ 

AwaitAck ()  ; 
if(++j— ID  j-O; 

} 

break; 

case  ' I' ; 
j-0; 
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clrscr  ()  ; 

printf  ("\n  Interactively  send  position  requests  4  varv.ro  servo  ; 
requests  \n") ; 

printf  ("  to  HC1 1 .  Press  any  key  to  exit.”); 

WaitForEntec  ( ! ; 
while ( ! kbhit  ( ) ) 

{ 

PosOrSer=  '  P'  ; 

ClearRXbuffer  ( ) ; 

TXfirst () ;  /*  Transmit  first  char  of  the  PosPeqS.tf  • 

AwaitAck  ( ) ;  / *  * / 

clrscr ( ) ; 

DisplayData ( )  ; 

PosOrSer=' S'  ; 

VariableServoControlValues ( j) ; 

FillSerReqBuf f ( ) ; 

ClearRXbuf  fer ( ) ; 

TXfirstO;  /*  Transmit  first  char  of  the  PosReqBuff  */ 
AwaitAck ( )  ; 
if(++j=«ll)  j=0; 

) 

break; 
case  ' V' : 

PosOrSer=' S ' ;  /*  TX  servo  control  values  */ 

ContinueKeyboard=*TRUE; 

Def aultServoControlValues () ; 
cl rscr ( ) ; 

printf ("\n\n  Type  capital  letters  to  increase  4  lowercase  letters 
decrease  \n") ; 

printf ("  servo  control  settings\n" ) ; 

printf  ("  (T)hrottle,  (A) ileron,  (E) levator,  (R) udder,  (C)oilectrve 
printf  ("  Type  <2  to  quit  this  sessionXn")  ; 

WaitForEnter () ; 

while (ContinueKeyboard) 

f 

KeyboardServoControlValues ( ) ; 
clrscr ( ) ; 

FillSerReqBuf f ( ) ; 

ClearRXbuf fer ( ) ; 

TXfirst ()  ; 

AwaitAck ( )  ; 

1 

break; 

case  ' T' ; 
clrscr ()  ; 

printf ("\n  Delay  time  -  %d  ms.\n",  delaytime); 

printf ("  Delny  time  3hould  be  greater  than  4  ms.  \n"); 

printf ("  Enter  new  time  in  milliseconds  to  delay  between  transmiss 

">  ; 

scanf fidelaytime)  ; 
break; 

case  '  C  : 
clrscr { ) ; 

BeginChangeComPort : 

printf ("\n  Change  Com  Port  Value.  Com  port  »  %d.  \n” , SERIALPORT ) ; 
printf ("  Enter  new  value  for  Com  port  (1  or  2);  \n"); 
scanf  & SERI ALPORT) ; 

if ( {SERIALPORT  <  1)  II  (SERIALPORT  >  2)) 
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(  print f  ("  Invalid  Com  pert  value  =  *d.  Re-enter  r." ,  SERIAIPCRT 
goto  BeginChangeCoraPort;  ! 

SERIALP0RT**1 ;  /*  set  port  to  com  1  */ 

disabled;  /*  General  interrupt  mask  */ 

InitSerialPort () ;  /*  Initialize  the  UART :  baud,  pert...* 

InitTXparmO ;  /*  Initialize  the  TX  parameters  */ 

InitRXparm ( ) ;  /*  Initialize  the  RX  parameters  */ 

enabled;  /*  General  interrupt  mask  */ 

break; 

case  ' Q' ; 

RestoreOldlSR ()  ; 

ContinueIt=FALSE; 
break; 

default : 

printf ( "Invalid  key 
break; 

1  /*  end  switch O  */ 

1  /*  end  while  loop  for  Continuelt  **  TRUE  */ 

1  /*  end  main  routine  */ 

/*******************»**********************»*»*«*»*»*»»«*»*»*«»*«*«  »  «  / 
/*  this  function  awaits  acknowledgement  from  the  HC11  &  displays  an  */ 
/*  error  message  if  it  isn't  received  in  time  */ 

/*  +  ********itir*lr***x*irlr********************************  +  itltx*M0Xir****  +  */ 


/•  Restore  the  old  interrupt  service  routine  * 


hit--  reenter  \n\n")  ; 


void  AwaitAck (void) 

( 

delay (delaytime) ; 
while (RXint_Enabled) 

{  if  (  (biostime  <  0)  >  (TXtime  +  ONEJ3IOS__S£COND) )  ) 

{  printf ("  Timeout:  ACK  not  Received~f rom  HCll!  \n"); 
DisablePC_RXint ( ) ;  /*  set  equal  to  true  so  that  user  screen  becomes 

available  */ 

1 

}  /*  end  while  RXint_Enabled  */ 

)  /*  end  function  AwaitAck ()  */ 

/************************************************tr*******w*****w****»*«r*«r* 

/*  Function  to  initialize  the  UART,  attach  the  new  ISR,  save  the  old  ISR  * 

/********************************-************************»*«***********w*  * 

void  InitSerialPort (void) 

{ 

initserial.  set '  al_initial— bits . parity-  PARITY--2  ?  3  :  PARITY  ; 
initserial . serial~initial_bits . stopbits*  STOPBITS-1; 
initserial. serial_initial_bit3 .wordlen-  WORDLEN-5; 
initserial. serial~initial_bits .brk  «Q; 
initserial , seriai_initial_bits . divlatch  -1 ; 

outportb(LIHECTL, initserial . serial_initial_char) ; 

outportb(DIVLSB, (char)  ( (115200L/BAUD)  i  255)); 
outportb(DIVMSB, (char)  ( (115200L/BAUD)  »  8)  >  ; 

initserial. serial_initial_bits .divlatch  -  0; 
cutportb (LINECTL, initserial . serial_initial_char) ; 

initializelSR () ; 
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/•**■***-*******-*■*■*-*•**  ***************,***»***-»*w-******>r«******r.*!r  .  r  ,  ,  *  „  „  ,  „  ,  ..  . 

/*  Initializes  ISR  for  TX  &  RX  over  serial  port  of  ?C 

Jii1r1(irir-kirir1tit'it1t****1t1t*1tlt1t-**-*******it*****-*K-**nnK**x***'**n****-*wjrv*  •  *  *  *  «  *  a  *  «  • 

void  initializelSR (void) 


oldserialint  -  getvect (SERIALINT) ;  /*  save  the  old  ISR  address  */ 

setvect (SERIALINT, newserialint ) ;  /*  attach  the  new  ISR  to  the  vector  * 

outportb (MODEMCTL, (inportb (MODEMCTL)  5  OxEF  I  DTR  !  RTS  ,  CUTS)); 

outportb (PICQ1 ,  (inportb  (PIC01 )  &  SERIALIRQ) ) ;  /*  enable  the  iZ:}  _r.ce 

outportb (PICOO , EOI) ; 

inportb (RXDATA) ; 
inportb (INTIDENT) ; 
inportb (LINESTATUS) ; 
inport (MODEMSTATUS) ; 

/*  printfC  Serial  port  initialized. \n" )  ;  */ 

} 

/*  Restore  the  old  ISR  attached  to  the  com  that  we  have  used  '/ 
void  RestoreOldlSR (void) 

( 

setvect (SERIALINT, oldserialint)  ; 
printfCOld  ISR  restoredNn")  ; 

} 

/****★*★*★★**★★**★★*****★**********★****★******★**********************«** 
/*  Initialize  parameters  for  TX  to  68HC11  board  '! 

void  InitTXparm (void) 

< 

/*  Buffer  to  request  position  values  of  the  heliocopter  */ 

PosReqBuf f [START_CHAR_INDEX] «START_CHAR; 

PosReqBuf f [COM  CHAR_INDEX] =POS_REQ_CCM_CHAR; 

PosReqBuff [POS_REQ_STRING_LENGTH-l ] -STOP_CHAR; 

TXindex-0; 

} 

/*********«**************************•»***************************»****»«» 
/*  Prompts  user  for  values  to  request  servo  control  on  heliocopter. 

/***********#**********************#**********************w***********»«* 

void  FillSerReqBuf f (void) 

f 

SerReqBuf f [START_CHAR_INDEX] =START_CHAR; 

SerReqBuf f [COM_CHAR_INDEX] «SER_REQ_COM_CHAR; 

SerReqBuf f [THROTTLE_MSB]  -(unsigned  char) (ServoValues  [THROTTLE]  »3 ) 
put  msbits  here  */ 

SerReqBuf f[THROTTLE_LSB]  -  (unsigned  char) ServoValues [THROTTLE] ; 
lsbit3  here  */ 
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printf ("Throe tie : 


%4d\n“. Servo Values [THROTTLE] i ; 

SerReqBuf f [AILERCN_MSB]  = (unsigned  char)  (ServoValues  [AILERON] »i ■ 
put  msbits  here  */ 

SerReqBuf f [AILERON_L5B]  =  (unsigned  char) ServoValues  [AILERON] ;  ' 

isbits  here  */ 

printf ("Aileron:  %4d\n", ServoValues [AILERON] ) ; 

SerReqBuf f [ELEVATOR_MS3]  -(unsigned  char) (ServoValues [ELEVATOR] >>-.  : 
put  msbits  here  */ 

SerReqBuf f [EL£VATOR_LSB]  =  (unsigned  char ) ServoValues ; ELEVATE? ] ; 
Isbits  here  */ 

printf ("Elevator:  %4d\n", ServoValues [ELEVATOR] ) ; 

SerReqBuf f [RUDDER_MSB]  -(unsigned  char) (ServoValues [RUDDER] >>i , ; 
msbits  here  */ 

SerReqBuf  f  [RUDDER_LSB]  =  (unsigned  char)  ServoValues  [RUDDER]  ;  *  put 

Isbits  here  */ 

printf ("Rudder:  %4d\n", ServoValues [RUDDER] )  ; 

SerReqBuf f [COLLECT IVE_MSB]  -(unsigned  char) (ServoValues [COLLECTIVE] >> 
/*  put  m3bits  here  */ 

SerReqBuf f [COLLECTIVE_LSB]  -  (unsigned  char) ServoValues [COLLECTIVE] ; 
put  Isbits  here  */ 

printf ("Collective :  %4d\n", ServoValues [COLLECTIVE] ) ; 

SerReqBuf f [SER_REQ_STRING_LENGTH-2  ] -Checksum (SER_REQ_ST?ING_LENGTH, 
SerReqBuff) ;  /*  Calculate  Checksum  for  servo  control  values  */ 

SerReqBuf f [ SER_REQ_STRING_LENGTH-1  ] =STOP_CHAR; 

]  /*  end  function  FillSerReqBuf f */ 


/*  Takes  input  from  keyboard  to  determine  servo  control  values. 

/A***************************************************************  *  *  *  *  t  *  *  n  *  * 

void  EnterServoControlValues (void) 

{ 

printf ( "NnEnter  servo  control  value  between  2000  s  4000  for  THROTTLE: 
scanf ("%d",  SServoValues [THROTTLE] ) ; 

printf ("\nEnter  servo  control  value  between  2000  &  4000  for  AILERON: 
scanf ("%d",  SServoValues [AILERON] ) ; 

printf ("\nEnter  servo  control  value  between  2000  &  4000  for  ELEVATOR: 
scanf ("%d",  SServoValues [ELEVATOR] ) ; 

printf <"\nEnter  servo  control  value  between  2000  S  4000  for  RUDDER: 
scanf ("%d",  SServoValues [RUDDER] ) ; 

printf ("\nEnter  servo  control  value  between  2000  &  4000  for  COLLECTIVE: 
scanf ("%d",  SServoValues [COLLECTIVE] ) ; 

}  /*  end  function  EnterServoControlValues 0* / 

void  DefaultServoControlValues (void) 

( 

printf ("NnLoading  Default  Servo  Control  Values  \n"); 
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ServoValues [THROTTLE] -THROTTLE  DEFAULT; 
ServoValues [AILERON] =AILERCN_DEF AULT; 
ServoValues [ELEVATOR] -ELEVATOR_DEFAULT; 
ServoValues [RUDDER] =RUDDER_DEFAULT; 
ServoValues [COLLECTIVE] -COLLECT IVE_DEFAULT; 

i  /*  end  function  DefaultServoControlValues  */ 

void  VariableServoControlValues {inc  multiplier) 


printf  ("\nLoading  Variable  Servo  Control  Value  set  #  *d  •  n",  rr.ul 

ServoValues  [THROTTLE!  =ONE_MS+  (int)  {(multiplier  *  CNE_.XSi.li); 

ServoValues  [AILERON;  =ONE_MS+  (int)  ((multiplier  *  CNE_MS)/'ii); 

ServoValues [ELEVATOR] =ONE_MS+ (int) ((multiplier  *  CNE_MS)/ii); 

ServoValues [RUDDER] =ONE_MS+ (int) {{multiplier  *  0NE_MS)/1C); 

ServoValues [COLLECTIVE] =0NE_MS+ (int) ((multiplier  *  ONE_MS)/i: 

}  /*  end  function  VariableServoControlValues  */ 
void  KeyboardServoControlValues (void) 

{ 

while (kbhit ( ) ) 

{ 

switch (getch ( ) ) 

{  case  ' T' : 

ServoValues [THROTTLE] +«SERVO_CHANGE_RATE; 
break; 
case  ' t' : 

ServoValues [THROTTLE] — SERVO_CHANGE_RATE; 
break; 
case  ' A' : 

ServoValues [AILERON) +«SERVO_CHANGE_RATE; 
break; 
case  ' a' : 

ServoValues [AILERON] — SERVO_CHANGE_RATE; 
break; 
case  ' E' : 

ServoValues [ELEVATOR] +«SERVO_CHANGE_RATE; 
break; 
case  ' e' : 

ServoValues [ELEVATOR] — SERVO_CHANGE_RAT£; 
break; 
case  ' R' : 

ServoValues [RUDDER] +-SERVO_CHANGE_RATE; 

break; 
case  ' r'  : 

ServoValues [RUDDER] — SERVO_CHANGE_RATE; 
break; 
case  'C' : 

ServoValues [COLLECTIVE] +-SERVO_CHANGE_RATE; 
break; 
case  ' c' : 

ServoValues [COLLECTIVE] — S£RVO_CHANGE_RATE; 
break; 
case  ' Q' : 
case  'q'  : 

ContinueKeyboard-FALSE; 
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break; 
default : 
break; 

}  /*  end  switchO  */ 

}  /*  end  while (kbhit  () )  */ 

}  /*  end  function  KeyboardServoControiVaiues ( )  */ 

/*  Initiates  TX  Sequence  to  the  HC11 

/************«*****************************************»«»»»«»*»»,»»«,,.«,,» 
void  TXf irst (void) 

{ 

TXindex*l;  /*  This  will  be  the  index  that  the  ISR  will  use  to  TX  tr.e  c  offers 
first  value  */ 

/*  This  is  not  the  TX  ISR  V 

while (getbit (inportb ( LINE STATUS ) , 5 ) “”0 )  (putch('w');  putohf'''); 

/*  wait  for  TX  to  complete  */ 
switch (PosOrSer) 

t 

case  ' P' : 

OUtportb  (TXDATA, PosReqBuf f [START_CHAR_INDEX] )  ; 

EnablePC_TXint ( )  ; 
break; 

case  ' S' : 

OUtportb (TXDATA, SerReqBuf f [START_CHAR_INDEX] ) ; 

EnablePC_TXint ( )  ; 
break; 

default : 

printf ("Error  Unknown  Type  of  TX  \n")  ; 
break; 


1 

TXtime-biostime (0) ; 
) 


/*  initialized  flags  and  semaphores  for  receiving  data  from  HC11 

/a****************************************************************  *  *  *  *•  »  *  w  »  »  * 

void  InitRXparm(void) 

( 

RXstream-FALSE; 

RXindex*Q; 

outportb (LINECTL, (inportb (LINECTL) 10x80) ) ; 

/*  printf ("DLAB  bit  in  LCR  is  set  *  1");  */ 

/*  printf  ("LCR  ■  0x%x\n", inportb (LINECTL) ) ;  */  /*  Line  Control  Register  * 

/*  printf ("BAUDO  -  0x%x  ", inportb (DIVLSB) ) ;  */ 

/*  printf  CBAUD1  -  0x%x  ", inportb (DIVMSB) ) ;  */ 
outportb (LINECTL, (inportb (LINECTL) S0x7f ) ) ; 

/*  printf ("DLAB  bit  in  LCR  is  set  -  0  ") ;  */ 

/*  printf ("DATA  -  0x%x\n",  inportb (RXDATA) ) ;  */  /*  Receive  data  value  * 

/*  printf ("LCR  »  0x%x\n",  inportb (LINECTL) ) ;  */  /*  Line  Control  Register  * 

/*  printf ("MCR  *  0x%x\n",  inportb (MODEMCTL) ) ;  */  /*  Modem  Control  Register 
*/ 

/*  printf ("IER  -  0x%x\n",  inportb (INTENABLE) ) ;  */  /*  Interrupt  Enable 
Register  */ 


74 


FAME/AFOSR  Hintz,  March  29.  1992 


2  x  k  :<  \  n 


/’  printf  ("LSR 
*  / 

!*  printf  ("MSR 
Values  */ 

/*  printf ("IIO 
l  Causes  */ 


Zxkx'xn" ,  ir.port fc  ( LINE3TATUS )  )  ; 
Ox%x\n"  ,  inearth  (MCDEMSTATC3)  i  ; 
Ox%x\n" ,  inpcrtb (INTIDENT) ) ;  V 


/***'**-*******-********-**'*jr**********ir*******«***»*wieit»r*«*  *  *  *  *r  «  ▼  »  *  *  -  *  *  «  »  •  »•  - 

/*  Clears  RX  buffer  */ 

j  *★****★★•**★★★*★**★***★*********■***********#**********#*#  *«r  *r*  w  *  *  *  *  *  *  *  *  v  »•  * 

void  CiearRXbuf fer (void) 

{ 

char  extra; 

while (getbit (inport (LINESTATUS) ,  0)  ) 

(  extra~inportb (RXDATA) ; 

printf ( "Cleared  byte  *  Ox%x  *  '%c'  from  serial  port  RX 
buffer . \n", (unsigned  char) extra,  extra); 

) 

}  /*  end  function  CiearRXbuf fer  */ 

/*  Checks  for  the  noise  and  overrun  errors  after  reception  */ 

void  RXerror (void) 

( 

if  ( (getbit (WorkLinestat ,3)  !=0)  I  I  (getbit(WorkLinestat,2)  ! =0 )  ) 
NoiseFraming=TRUE; 

else 

(  NoiseFraming=FALSE; 
if  (getbit (WorkLinestat, 1) ! =0) 

if  ( (RXindex=* (POS_ACK_STRING_LENGTH-l-l ) ) && (WorkRXdata— 5ro?_CH. 

Overrun=FALS£; 

else 

Overrun*TRUE; 

else 

Overrun=*FALSE; 

} 

) 

/★★AT********************************************************************* 

/*  Test  if  the  received  word  is  the  start  word 
/***★*★*★**★★*★*****★*******************■******■*■*★**■********************** 
void  ResearchStartChar (void) 

(  if  (WorkRXdata— ■ START_CHAR) 

( 

RXstream-TRUE ; 

RXind*X-START_CHAR_INDEX ; 

f*  patch ('A');  putch('!');  A!  start  char  received!  */ 

1 

else 

{  putch('S');  putch('!');  }  /*  display  Si  for  start  char  not  received 

) 

/**********************************»***«*********»************»**«•»»»►••«» 
/*  Function  to  receive  data  from  the  HC11 

/*******##*************************************************#******-»W****« 

void  CharRX(void) 
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( 


RXindex++; 

if (RXindex--  _CHAR_INDEX)  /*  should  this  be  the  Ccmrr.ar.a  Character:  • 
(  Work-  -mandChar=WorkRXdata  ; 
switch (WorkCommandChar)  ■ 
case  P  0  S  _  AC  K_C  C M_C BAR : 

PosAckBuf f [COM_CHAR_INDEX] =WorkRXdata; 
break; 

case  SER_ACK_COM_CHAR: 

PosAckBuf f [COM_CHAR_INDEX] -WorkRXdata; 
break; 

default ; 

putch ( ' U' ) ;  Dutch ('!'); 

ClearWorkVar ( )  ; 

break; 

}  *  end  switch  for  Command  Character  */ 

}  /*  end  should  this  be  the  Command  Character  */ 

else  {  /*  this  is  not  the  command  character  */ 

switch (WorkCommandChar)  { 

case  POS_ACK_COM_CHAR : 

if (  (RXindex  >  COM_CHAR_INDEX) 

&& (RXindex  <«  (POS_ACK_STRING_LENGTH-l-l ) )  ) 

{  PosAckBuf f [RXindex] “WorkRXdata;  /*  put  Position  or  Checksum 
values  into  array  to  be  un-concatenated  */ 

/*  putch ('I');  print  'I'  to  the  screen  */ 

) 

else 

if (RXindex  ~  POS_ACK  STRING_LENGTH-1) 

{  if (WorkRXdata  —  STOP_CHAR) 

{  CompleteStreamO  ; 

DisablePC_RXint () ;  } 

else  {  putch ('Y');  putch {'!');  ClearWorkVar () ;  i  j 
else 

{  ClearWorkV  ;);  putch ('Z');  putch ('!');  } 

/*  error  out  of  synch  */ 
break; 

case  SER_ACK  COM__CHAR:  /*  is  this  a  servo  control  acknowledgement 
if (RXindex»«SER_ACK_STRING_LENGTH-l )  /*  should  this  be  the  stop 

char?  */ 

if {WorkRXdata--STOP_CHAR)  /*  is  this  the  stop  char?  */ 

{  ClearWorkVar ( )  ; 

/*  putch('R');  putch('!');  Servo  Control  Acknowledgement  RXe 
)  /*  disable  rx  inter  */ 

else  /*  error  */ 

{  putch ('W' );  putch('!');  ClearWorkVar () ;  } 

else 

{  putch ('X');  putch('i');  ClearWorkVar () ;  } 
break; 

default ; 

printfC’Work  Control  Word  Not  Recognized  as  RXed  ”)  ; 

ClearWorkVar  ; 
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break; 

)  /*  End  of  switch!)  */ 

}  /*  End  of  else  this  shouldn't  be  the  Command  Character  ' 

)  /*  end  function  CharRX  */ 

/*  initialize  semaphores  for  RXing  a  new  string  from  the  HCil. 

/*ici*it1t*-*-****1t*-k*****ie**±*-K*-K*‘****-**xxirit*ifirntin**-K-K**icic-x*xKX-K-K*njr*K*  *  *  *  *  *  *  *  *  *  * 

void  ClearWorkVar (void) 

{  int  i; 

RXindex=0 ; 

RXstream=FALS£; 

DisablePC  RXintO; 


^H*rx*XXiT*x1r*ir*XX***xxx*xX***xxxxxxx*x*xxxwx*xxxxxxxxxwK»rittirr»  «  «  *  *  *  *  •  *  «  »  *  -  •  « 

/*  Called  upon  RX  of  Step  char  of  Position  acknowledgement  secuer. :e 

/xnxyt1tir*x*xXir*XXX*XxirxnxxxxxxxnXx*c*x*KXXXXxXMXxnxx  **»*»«**■*■*■*«  «  **»»  «r  «■  *  *  »  «  *•  *  * 

void  CompleteSt ream (void) 


if  {  PosAckBuff  [POS_ACK_STRING_LENGTH-l-l]  »=  Checksum  (?CS_ACK_ST?.:.\3_lENGTh: 
PosAckBuff)  )  /*  Checks  if  the  checksum  is  correct  *! 

{ 

/*  printf ("\nStream  complete\n") */ 

/*  printf ( "command  char  =  %x  \n" ,  WorkCommandChar) ;  */ 

NewData»TRUE; 

} 

else 

{  printf ( "Checksum  Error;  RXed  Checksum®  %x,  Calculated  Checksum  =  %x 
\n" , PosAckBuff [P0S_ACK_STRING_LENGTH-1-1 ] ,  Checksum (POS_ACK_STRING_lENGtH, 
PosAckBuff) ) ;  ) 

ClearWorkVar ( ) ; ) 

/*»************■**************************************************•*»»«»*«*»,■, 
/*  This  function  calculates  the  checksum  of  sequences 

/*  ignores  Oth,  last,  and  (last  -  1)  elements  of  array 
/*  i.e.,  it  ignores  the  start,  checksum,  and  stop  characters 
*/ 

/********************************************************♦*********»*»***»«* 
unsigned  char  Checksum(int  stringlength,  unsigned  char  CheckArray [] ) 

( 

unsigned  char  ChecksumResult  =  0; 
unsigned  int  sum  =  0; 

int  i; 

ford  -  1;  i  <  stringlength  -  2;  i++) 
sum  -  sum  +  CheckArray [i] ; 

ChecksumResult  •  (unsigned  char) sum; 
return  ChecksumResult; 

)  /*  end  checksum  function  */ 
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/*  concats  2  unsigned  characters  to  an  integer 

*  / 

^*itirit*************ifit*******ir*XKti*^itM*-»tctiiinKii**itiiit:irieM*^iewKMn  m  *  «r  w  w  %  »  *  .  .  *  .  ,  .  .  » 

int  Concat_Int (unsigned  char  MSbits , unsigned  char  LSfcirs) 

{  unsigned  int  result; 

result* (int) MSbits; 
result* ( result  <<  8); 
result=resuit+LSbits ; 
return  result; 


/  +  it1tit**it**it***-k**1eifklt1tit1fk*itif*'k*1tit******irlt***ir**-**1tir*  +  x*****x**itxirttxirm-K  *  *  «  *  * 

/*  Concats  Position  values  from  the  RX  buffer  &  displays  them  tc  the  screen 

//*************«*****************-***'***-***********irw**wjrir**w*jrir*w  n  »  *  w  it  *  *  *  «  *  * 

void  DisplayData (void) 

{  int  i; 


clrscr  ()  ; 


printfC  X* 

%7 . 2f 

cm 

\n" 

PosAckBuff [X 

LSB] ) /100 

)  ; 

printfC  Y=~ 

%7.2f 

cm 

\n" 

PosAckBuff  [Y 

LSB] ) /100 

)  ; 

printfC  Z=‘ 

%7.2f 

cm 

\n" 

PosAckBuff [ Z_ 

LSB] ) / 100 

) ; 

(float) Concat_Int (PosAckBuf f [X_MS3]  , 
(float) Concat_Int (PosAckBuf f ' Y_MSB j  , 
( float )  Concat  Int  (PosAckBuf  f  [  2  MSB;, 


printfC  Pitch*  %7.2f  deg  \n", 
PosAckBuff [PITCH_LSB] ) /100  ); 

printfC*  Roll*  %7.2f  deg  \n", 
PosAckBuff [ROLL_LSB] ) / 1 00  ); 

printfC  Yaw*  %7.2f  deg  \n", 
PosAckBuff  [YAW  LSB])/100  ); 


(float) Concat_Int (PosAckBuff [PITCH_MSB1  , 
(float) Concat_mt  (PosAckBuff  [ROLL_.M52 ;  , 
(float) Concat  Int (PosAckBuff [YAW  MS3]  , 


/*  printfC  X*  %7.2f  cm  MSB:  12x  LSB:  %2x\n", 

( float )Concat_Int (PosAckBuf f [X_MSB] ,  PosAckBuf f [X_LSB] ) /10C, 
PosAckBuff [X_MSB] ,  PosAckBuff [X_LSB]  ); 

printfC  Y»  %7.2f  cm  MSB:  %2x  LSB:  %2x\n", 

( float )Concat_Int (PosAckBuf f [Y_MSB] ,  PosAckBuff [Y_LSB] ) /100, 
PosAckBuff [Y_MSB]  ,  PosAckBuf f [Y_LSB]  ); 

printfC  Z-  %7.2f  cm  MSB:  %2x  LSB:  %2x\n", 

( float )Concat_Int (PosAckBuff [Z_MSB] ,  PosAckBuf f [ZJLSB] ) /100, 
PosAckBuff [Z  MSB],  PosAckBuff [Z  LSB]  ); 


printfC  Pitch-  %7.2f  deg  MSB:  %2x  LSB:  %2x\n", 

(float) Concat_Int (PosAckBuf f [PITCH_MSB] ,  PosAckBuf f [PITCH_LSB] ) /100, 
PosAckBuff [PITCH_MSB] ,  PosAckBuf f [PITCH_LSB]  ); 

printfC  Roll-  %7.2f  deg  MSB:  %2x  LSB:  %2x\nM, 

(float)Concat  Int (PosAckBuf f [ROLL_MSB] ,  PosAckBuf f [ROLL_LSB] ) / 1 00 , 
PosAckBuff tROLL_MSB] ,  PosAckBuf f [ROLL  LSB]  ); 

printf ("  Yaw-  %7.2f  deg  MSB:  %2x~  LSB:  %2x\n", 

(float) Concat  Int (PosAckBuff [YAW_MSB] ,  PosAckBuf f [YAW_LSB] ) / 1 00 , 
PosAckBuff [YAW  MSB] ,  PosAckBuff [YAW  LSB]  ); 

*/ 

for (i-0;  i<-POS  ACK  STRING  LENGTH-1  ;  i++)  PosAckBuf f [i] *0; 


} 


/* - 

/*  ISR  for  transmitting  to  HC11 
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void  PC_TX_I5R (voii) 

( 

switch (PosOrSer) 

{ 

case  'P':  /*  We  want  to  transmit  the  PosP.eq  Suffer  * 

while  (getbit  (ir.portb  (LIN’ESTATUS)  ,  5)  ==0)  •  cuter.  ( '  y'  i  ;  cuter.  • '  :• 

outportb  (TXDATA, PcsReqBuff [ TX index  j )  ; 

if  (TXindex++==PGS_REQj3TRING_LSN’GTH-l )  ■  Disable?  D_rXi.-.t  . 

EnablePC_RXi:.t  0  ;  i 
break; 

case  'S':  /*  We  want  to  transmit  the  serve  cor.tr:  1  par  arete, 

while  (getbit  (inportb  (DINESTATU5)  ,  5)  ==0)  ;  putch  { '  z '  i  ;  cuter,  t '  '  '  . 
outportb (TXDATA, SerReqBuf f [TXindexj )  ; 

if  (TXindex-f+==SER_REQ_STRING_LENGTH-l )  (  DisabIePC_TXiht  ( )  ; 
EnablePC_RXint  0 ;  } 

break; 

default ; 

printf ( "general  error  \n"); 
break; 

}  /*  end  switch!)  */ 

} 


/* - - - - - 

/*  Reception  ISR  */ 

/  * - -  J 


void  PC_RX_ISR (void) 

{  WorkRXdata=*inportb (RXDATA) ; 

/*  putch (WorkRXdata) ;  putch('*');  display  values  received  from  HCil*/ 
WorkLinestat*inportb (LINESTATUS) ; 

RXerror ( ) ; 

if  (  (Overrun==FALSE) ss (NoiseFraming==FALSE) ) 

if  (RXstream==FALSE)  /*  we  want  the  start  char  */ 

{  /*  putch('f');  */  ResearchStartChar ( ) ;  ) 

else 

{  /*  putch('t');  */  CharRXO;  > 

else 

ClearWorkVar ( )  ; 

) 

/* - 

/*  New  communication  interrupt  service  routine 
/* - 

static  void  interrupt  far  newserialint (void) 

{  char  identreg; 

identreg-inportb (INTIDENT) ; 

switch  (identreg) 

1 

case  4: 

PC_RX_ISR<)  ; 
break; 

case  2: 
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?c_rx_:sR ( )  ; 

brea<; 
default : 

printf  ( "default  ir.t\n"); 
ir.portb  (RXDATA)  ; 
break; 


} 

y'«*-*-«{-ir'*r***#*'*****-»*#*r^*K>rir***r**'*jrj»w»**-»'***w**wjr*r*it*w***»'«*-**»»  *»>**  ,  .  •  . 

/*  Pauses  for  user  to  read  message  on  screen. 

void  WaitForEnter ( void) 

{ 

printf ("\n  Press  any  key  to  begin."); 
while ( ! kbnit  ( )  )  ; 

getch ( ) ; 

)  /*  end  function  WaitForEnter ( )  */ 

/’ - * 

/*  File  which  contains  some  basic  functions  */ 

/* - - 

unsigned  char  clearbit (unsigned  char  reg, unsigned  char  NumBit) 

(  unsigned  char  treg; 

switch (NumBit) 


case 

0:  treg 
break; 

reg 

& 

MASKO ; 

case 

1:  treg 
break; 

S3 

reg 

& 

MASK1 ; 

case 

2:  treg 
break; 

3S 

reg 

& 

MASK2; 

case 

3;  treg 
break; 

S3 

reg 

& 

MASK3 ; 

case 

4:  treg 
break; 

a 

reg 

& 

MASK4 ; 

case 

5:  treg 
break; 

at 

reg 

& 

MASK5; 

case 

6;  treg 
break; 

* 

reg 

& 

MASK6; 

case 

7 :  t  reg 
break; 

* 

reg 

& 

MASK?; 

return {treg) ; 

) 


unsigned  char  setbit (unsigned  char  reg, unsigned  char  NumBit) 
(  unsigned  char  treg; 

switch (NumBit ) 

{  case  0:  treg  -  reg  I  CMASKO; 
break; 
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case 

- 

•  7  reg 
break; 

reg 

CMASX1 

case 

2 

:  treg  = 
break; 

reg 

CMASKI 

case 

3 

:  treg  = 
break; 

reg 

CMA5K3 

case 

4 

;  treg  * 
break; 

reg 

CMA5K4 

case 

5 

;  treg  = 
break; 

reg 

C MASKS 

case 

6 

:  treg  = 
break; 

reg 

CMASKS 

case 

7 

;  treg  = 

reg 

CMASK7 

break; 


return (treg) ; 

} 


unsigned  char  getbit  (unsigned  char  reg,  unsigned  char  Nurr3it) 

[ 

unsigned  char  BitResult; 
switch (NumBit) 

{  case  0:  BitResult* (reg  &  CMASKQ) ; 
break; 

case  1;  BitResult* ( reg  &  CMASK1); 
break; 

case  2;  BitResult* ( reg  &  CMA3K2) ; 
break; 

case  3;  BitResult* ( reg  &  CMASK3); 
break; 

case  4:  BitResult* ( reg  &  CMASK4 ) ; 
break; 

case  5:  BitResult* ( reg  &  CMASKS); 
break; 

case  6;  BitResult* ( reg  &  CMASKS > ; 
break; 

case  7;  BitResult* ( reg  &  CMASK7); 
break; 

} 

return (BitResult) ; 

1 
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6.5.  Appendix  V:  Mechanical  Drawings 


Material; 


Top  View 


0-1/2* -*i 
1 


0  0-1/8* 
r~\ 

3d  S. 


Front  View 


1/8*  Alumlr.jm 

Bracket  NB2 


Orawlng  #2 
Ken  Hlntz 

Ceorge  Mason  uni  vers:  'u  ; 

8/20/91 

(703)993- 1592 


Figure  2  Bracket  supporting  potentiometer  at  center  of  base  (H)  of  stand. 
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Figure  3  Relative  location  of  brackets  and  potentiometers  at  middle  joint. 
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Figure  4  Bracket  for  supporting  azimuth  potentiometer  at  middle  joint. 
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5' 5/8' 


Figure  5  Bracket  for  supporting  elevation  potentiometer  at  middle  joint. 
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Make  Adapter  Shaft 
Quantity:  2 
Material:  Steel 


Drawing  #2 
Ken  Hintz 

George  Mason  University 
11/1/91 

(703)993-1592 


Figure  6  Adapter  shaft  to  connect  potentiometer  to  H-potentiometer  and  Azimuth-Potentiometer. 
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Top  View 


Side  View 


Material:  1/8"  Aluminum 

Bracket  NB1 


Figure  8  Bracket  to  support  yaw  potentiometer  which  connects  directly  to  virticai  helo  support  shaft 
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POT 


Nylon  Block 
Roller  Bearing 


Snap  Ring 


Figure  9  Relative  location  of  support  components  at  helicopter  end  of  stand. 


Figure  10  Shalt  to  support  helicopter  and  connect  to  yaw  potentiometer.  Length  could  be  extended 
to  increase  range  of  motion  and  still  prevent  tail  rotor/boom  strikes  to  stand. 
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